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B.1.1  UupOO.for 

PROGRAM  EXOSIM 

-  Declare  and  initialize  variables 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

CHARACTER* 12 8  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  STORAG  /  XINT  ,  TINT  ,  XDOTL 

COMMON  /  RMASS  /  TLSTM  ,  MASSL 
COMMON  /  RMISSL  /  XYZLCH 

REAL  XINT (50)  ,  TINT (50)  ,  XDOTL (50) 

REAL  XYZLCH (3)  ,  MASSL 

C  OUTPUTS 


REAL 

MXVCS 

/ 

MYVeS 

t 

MZVeS 

REAL 

MXACS 

! 

MYACS 

/ 

MZACS 

REAL 

MX 

/ 

MY 

t 

MZ 

REAL 

MACH 

REAL 

MDOTV 

t 

MDOTA 

REAL 

CIM(9) 

NAMELIST  INPUTS 

REAL 

IXX 

t 

lYY 

t 

IZZ 

REAL 

(4ASS 

REAL 

IMPULS 

t 

0UAT(4) 

r 

MDOT 

REAL 

QUATD (4) 

INTEGER 

SEKTYP 

REAL 

TSTEP,DELT, 

LATLP 

,  LONGLP 

REAL 

TMSUDRIV,  TM.CUSTEP 

double  precision  d_xd,d_yd,d_zd 


*  DATA  INITIALIZATION 
$  INCLUDE  ( ' ''/ INCLUDE/ SSDATA35  .DAT' ) 
$  INCLUDE  ( ' INCLUDE /SSDATA3  8  .DAT  ' ) 
$  INCLUDE  ( '  /  INCLUDE /SSDATA3  9.  DAT ' ) 
SINCLUDE  ( '  ''/INCLUDE/SSDATA42  .DAT' ) 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA44  .DAT ' ) 
SINCLUDE  (  '  ''/INCLUDE/SSDATA45  .DAT  ' ) 
$  INCLUDE ( ' ^ / INCLUDE / SSDATA4  6 . DAT ' ) 
$ INCLUDE ( ' "/ INCLUDE/ SSDATA4 7 .DAT' ) 
$  INCLUDE  ( ' ''/ INCLUDE /SSDATA4  8.  DAT  '  ) 
$1NCLUDE(  '''/INCLUDE/SSDATA49.DAT' ) 
SINCLUDE  ( '  ''/INCLUDE/SSDATA50  .DAT ' ) 
$  INCLUDE  (  ' ''/ INCLUDE /SSDATAOl  .DAT  ' ) 
SINCLUDE  (  '  ''/INCLUDE/SSDATA17  .DAT  ' ) 
SINCLUDE  ( '  ''/INCLUDE/SSDATA18  .DAT ' ) 
$  INCLUDE  (  '-'/ INCLUDE/ SSDATA21  .DAT  ' ) 
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$  INCLUDE  ( ' ''  /  INCLUDE  /  SSD  ATA2  2  .  D  AT ' ) 

$INCLUDE  ( '  ''/INCLUDE/SSDATA23  .DAT  • ) 

$  INCLUDE  (  '  -'/ INCLUDE /SSDATA2  8  .  DAT ' ) 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA2  9  .DAT  ' ) 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA30  .DAT' ) 

$  INCLUDE  ( ' ''  /  INCLUDE/  SSDATA7 1 .  DAT ' ) 

$INCLUDE  ( '  ''/INCLUDE/SSTIMING . DAT ' ) 

$ INCLUDE ( ' SSpOO.DAT ' ) 

*  INITIALIZE  80x87 
CALL  CW87 

C - C 

C - main  EXECUTION  LOOP - C 

C - C 

C  Execution  of  all  events  is  performed  C 

C  within  this  loop  C 

C  C 

C - C 

c  call  initiali2e_timing {) 

1000  CONTINUE 

c  call  start_timing (0) 

C  WRITE(*,*)' - BEGINNING  OF  LOOP - ' 

C - C 

C - MISSILE  STATE  UPDATE  MODULE - C 

c . C 

C  Integrate  missile  states  to  current  time  C 

C  C 

c - - - . . . - . — c 

ClOOl  format (lx, f7 . 4, 3 (a, lpel3 . 6) ) 

C1002  format(lx,3(a,lpel3.6)) 

C  write (message, 1001) t, 'p  ',p, '  q  ',q, '  r  ',r 

C  call  outmes (message) 

C  write (message, 1002) '  pd  ',pd, '  qd  ',qd, '  rd  ' , rd 

C  call  outmes (message) 

C  write (message, 1002) '  cim(l)  ',cim(l),'  (2)  ',cim(2), 

C  *  '  (3)  ',cim(3) 

C  call  outmes (message) 

C  write (message, 1002) '  (4)  ',cim(4),'  (5)  ',cim(5), 

C  *  '  (6)  ',cim(6) 

C  call  outmes (message) 

C  write (message,  1002) '  (7)  ',cim(7),'  (8)  ',cim(8), 

C  *  «  (9)  ',cim(9) 

C  call  outmes (message) 

IF  (  tstep  .gE.  tmsudriv  )  THEN 

tmsudriv  -  tmsudriv  +  tmsuscep 

C - C 

C - mass  PROPERTIES  MODULE - C 

C - C 

C  Update  mass  flov/  rate,  eg  and  inertia  C 

C  C 

C - c 

CALL  MASSPR(T,MDOTA,MDOTV,MASS,EISP, IMASS, 
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MOOT, WEIGHT, WDOTTP,WDOTKV,WDOTTI, IXX, 
lYY, IZZ) 


VEHICLE  STATES  MODULE 


Compute  missile  state  derivatives 


CALL  MISSIL2 (T,  QUAT, CIM, P, Q, R, IXX, lYY, IZZ, 
MXACS, MXVCS, MYACS, MYVCS, MZACS, 
MZVeS,  XD,  YD,  ZD,  NCLEAR,  PD,  QD,  RD, 
MX,MY,MZ,U,V,W,QUATD,PHI,THT,PSI) 


MISSILE  STATE  INTEGRATION  MODULE 


Revise  missile  states  using  derivatives 
just  computed  .  Missile  states  must  not 
be  integrated  if  a  table  lookup  index 
transition  has  occurred  since  the  last 
integration  step  .  The  next  integration 
step  should  be  rescheduled  to  coincide 
with  the  earliest  detected  table  lookup 
index  transition  instead  .  otherwise 
schedule  the  next  integration  step  to 
occur  at  the  default  step  size  . 


TRAPEZOIDAL  INTEGRATION  FOR  SIMPLICITY 


CALL 

SpINTEG 

( 

MASS 

t 

MDOT 

r 

T  , 

1 

) 

CALL 

SpINTEG 

( 

WKV 

t 

WDOTKV 

t 

T  , 

5 

) 

CALL 

SpINTEG 

( 

P 

t 

PD 

r 

T  , 

12 

) 

CALL 

SpINTEG 

( 

Q 

/ 

QD 

9 

T  , 

13 

) 

CALL 

spINTEG 

( 

R 

f 

RD 

9 

T  , 

]4 

) 

CALL 

spINTEG 

< 

QUAT(l) 

r 

QUATD(l) 

9 

T  , 

I" 

) 

CALL 

spINTEG 

( 

QUAT (2) 

r 

QUATD(2) 

9 

T  , 

x6 

) 

CALL 

SpINTEG 

( 

QUAT (3) 

t 

QUATD(3) 

9 

T  , 

17 

) 

CALL 

spINTEG 

( 

QUAT (4) 

t 

QUATD{4) 

9 

T  , 

18 

) 

SAVE 

TIME  OF 

LAST  MISSILE  STATE  UPDATE 

TLMSU  =  T 


END  IF 


SEPARATION  MODULE 


Models  discontinuities  occuring  during 
stage  separation 


C  NOSE  FAIRING  /  BOOST  ADAPTER  SEPARATION 
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IF  (  IDROP.EQ.l  .OR.  (ABS (T-TDROP) . LE .DTEPS 
*  .AND.  IGTT.EQ.l  )  )  THEN 

WKV  »  WKV  -  WBANE- 

MASS  =  WKV/XMTOF 

WRITE  (MESSAGE,  15. ■5)  T 
CALL  OUTMES (MESSAGE) 

155  FORMAT (IX, El 6. 9,  '  DROP  NOSE  FAIRING'  AND  BOOST  ADAPTER') 

C  REINITIALIZE  PERTINENT  INTEGRALS 

CALL  spINTEGI  (  MASS  ,  O.OeO  ,  T  1  ) 

CALL  spINTEGI  (  WPROP  ,  O.OeO  ,  T  ,  2  ) 

CALL  SpINTEGI  (  IMPULS  ,  O.OeO  ,  T  ,  2  ) 

CALL  spINTEGI  (  WKV  ,  O.OeO  ,  T  ,  5  ) 

END  IF 


Processor  communication 


c  call  switch_timing 0 

C -  Communicate  with  pOl  - C 

CALL  SEND_REAL_32BIT (  IXX  ) 

CALL  SEND_REAL_32BIT (  lYY  ) 

CALL  SEND_REAL_32BIT(  IZ2  ) 

CALL  SEND_REAL_32BIT(  MASS  ) 

C -  Communicate  with  p03 - C 

CALL  SEND_REAL_32BIT (  P  ) 

CALL  SEND  REAL_32BIT(  Q  ) 

CALL  SEND"‘REAL_32BIT  (  R  ) 

C  CALL  RECETVE_REAL_64BIT(  d_XD  ) 

C  XD  =  ci_XD 

C  CALL  RECEIVE_REAL_64BIT(  d_YD  ) 

C  YD  =  d_YD 

C  CALL  RECEIVE_REAL_64BIT(  d_ZD  ) 

C  ZD  =  d_ZD 

CALL  RECEIVE_REAL_32BIT(  XD  ) 

CALL  RECEIVE_REAL_32BIT(  YD  ) 

CALL  RECEIVE_REAL_32BIT(  ZD  ) 

CALL  SEND_REAL_32BIT (  CIM(l)  ) 

CALL  SEND_REAL_32BIT (  CIM(2)  ) 

CALL  SEND_REAL_32BIT (  CIM(3)  ) 

CALL  SEND_REAL_32BIT (  CIM(4)  ) 

CALL  SEND_REAL_32BIT (  CIM(5)  ) 

CALL  SEND_REAL_32BIT(  CIM(6)  ) 

CALL  SEND_REAL_32BIT (  CIM(7)  ) 

CALL  SEND_REAL_32BIT(  CIM(8)  ) 

CALL  SEND_REAL_32BIT (  CIM(9)  ) 

C -  Communicate  with  pOl  - C 

CALL  RECEIVE_SIGNED_16BIT(  IDROP  ) 

C -  Receive  from  ACSTHR  and  VCSTHR  - C 

CALL  receive_REAL_32BIT (  mdotV  ) 

CALL  receive_REAL_3IBIT (  mdota  ) 

CALL  receive_REAL_32BIT (  mxvcs  ) 

■  CALL  receive_REAL_32BIT (  myves  ) 
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CALL  receive_REAL_32BIT (  mzves  ) 

CALL  receive_REAL_32BIT (  mxacs  ) 

CALL  receive_REAL_32BIT (  myacs  ) 

CALL  receive_REAL_32BIT (  mzacs  ) 

CALL  SEND_REAL_32BIT (  PD  ) 

CALL  SEND_REAL_32BIT (  QD  ) 

CALL  SEND_REAL_32BIT(  RD  ) 

c  call  switch_timing () 

C - C 

c - - - OUTPUT  MODULE - C 

c - c 

C  Creates  print  and  plot  output  data  C 

C  files  C 

C  C 

c - c 

c  call  stop_timing ( ) 

c  if  {  mod(int (tstep) , int (dtprt) ) .eq.O  )  then 

c  call  output_timing 0 

c  call  initialize_timing () 

c  ENDIF 

C - C 

c -  TERMINATION  LOGIC  - C 

C - C 

C  Defines  the  simulation  termination  C 

C  conditions  C 

C  C 

C - -C 

C  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 

lEXIT  =  0 

C  ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
C  EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED 

IF  (  T.GE.TFINAL  )  THEN 

lEXIT  =  1 
ENDIF 

C  increment  time 

TSTEP  =  TSTEP  +  l.OeO 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 

CALL  OUTMES ( 'ERROR:  Exit  from  POO') 

END 
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B.1.2  UupOl.for 

PROGRAM  EXOSIM 


Declare  and  initialize  variables 


IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  {0-Z) 

CHARACTER* 12 8  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
COMMON  /  ROBTRG  /  FIRST2  ,  TL2  ,  GRTPST 

COMMON  /  RNAVIG  /  GRLAST  ,  TONAV  ,  MNAV  ,  DTXO  ,  DTYO  , 

DTZO 


DOUBLE  PRECISION  TSTEP,DELT 
DOUBLE  PRECISION  TIMUDRIV, TGPUDRIV 
DOUBLE  PRECISION  TIMUSTEP, TGPUSTEP 


DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 


GRLAST (3)  ,  GRTPST (3) 

VTIC(5,3)  ,  rtic(5,3) 

GRT(5, 3) ,GRTEST(3) ,RTEST(3) ,VTEST(3) 
RREL{3) ,VREL(3) 


INTEGER 

INTEGER  SEKTYP 

FIRSTl 

,  FIRST2 

OUTPUTS 

DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 

MASS 

TI2M(9) 

QS1(4) 

VMIR(3) 

AT  (3) 

GR(3) 

,  VMI(3) 

,  CIE(9) 

NAMELIST  INPUTS 

DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 

XYZE{3) 

PULSEG(3) 

PULSEA(3) 

,  XYZED(3) 

DOUBLE  PRECISION  LATLP,LONGLP 

DOUBLE  PRECISION  RMIR(3) 


real  s_niass,  s_pulsea  (3) ,  s__pulseg(3) 
real  S_XD , S_YD , S_ZD , S_GR ( 3 ) 

*  DATA  INITIALIZATION 
$  INCLUDE  (  '"■/ INCLUDE/ SSDATA3b  .DAT' ) 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA3  8  .DAT ' ) 

$  INCLUDE  ( '  /  INCLUDE/  SSDATA3  9 .  DAT ' ) 
SINCLUDE  (  '  ''/INCLUDE/SSDATA42  .DAT' ) 
SINCLUDE  {  '  ''/INCLUDE/SSDATA44  .DAT' ) 

$  INCLUDE  (  '  ''/INCLUDE /SSDATA4  5  .DAT ' ) 

$  INCLUDE  ( '  -'  /  INCLUDE /SSDATA4  6  .  DAT  ' ) 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA47  .DAT  ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA48  .  DAT  ' ) 

$  INCLUDE  { '  ''/INCLUDE/SSDATA49.DAT’ ) 

$  INCLUDE  (  '  ''/INCLUDE/SSDATA50  .DAT  ' ) 
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^INCLUDE  (  '  -'/ INCLUDE /SSDATAOl  .DAT  ' ) 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA17  .DAT  ' ) 
$INCLUDE  ( '  ''/INCLUDE/SSDATA18  .DAT  ' ) 
$  INCLUDE  ( '  /  INCLUDE /SSDATA21  .DAT ' ) 
$  INCLUDE  ( ' ''/ INCLUDE /SSDATA2  2  .DAT ' ) 
$  INCLUDE  ( ' INCLUDE /SSDATA2  3  .DAT  ' ) 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA28  .DAT  ' ) 
$  INCLUDE  ( '  '•/ INCLUDE /SSDATA2  9  .DAT ' ) 
$  INCLUDE  ( ' ''/ INCLUDE /SSDATA30  .DAT ' ) 
$  INCLUDE  ( '  ''/INCLUDE /SSDATA71  .DAT  ' ) 
$INCLUDE  (  '  ''/INCLUDE/SSTIMING  .DAT  ' ) 
$ INCLUDE ( 'SSp01.DAT') 

*  INITIALIZE  80x87 
CALL  CW87 


C - 

c - main  execution  loop - 

c - 

C  Execution  of  all  events  is  performed 

C  within  this  loop 

C 

C - 


1000  CONTINUE 

C  WRITE(*,*)' - BEGINNING  OF  LOOP 

C - 

C - Processor  communication 

C— . - . — . 

c - COMMUNICATION  WITH  POO - C 

CALL  RECEIVE_REAL_32BIT (  S_GR(01)  ) 

CALL  RECEIVE_REAL_32BIT (  S_GR(02)  ) 

CALL  RECEIVE_REAL_32BIT(  S_GR{03)  ) 

GR(1)  =  S_GR(1) 

GR(2)  =  S_GR(2) 

GR(3)  =  S_GR{3) 

CALL  RECEIVE_REAL_32BIT <  s_MASS  ) 

MASS  =  s_MASS 

CALL  RECEIVE_REAL_32BIT {  S_PULSEA(01)  ) 

PULSEA(Ol)  =  s_PULSEA(01) 

CALL  RECEIVE_REAL_32BIT (  S_PULSEA{02)  ) 

PULSEA(02)  =  s_PULSEA(02) 

CALL  RECEIVE_REAL_32BIT (  S_PULSEA(03)  ) 

PULSEA(03)  =  s_PULSEA(03) 

CALL  RECEIVE_REAL_32BIT (  S_PULSEG(01)  ) 

PULSEG(Ol)  =  s_PULSEG(01) 

CALL  RECEIVE_REAL_32BIT{  S_PULSEG(02)  ) 

PULSEG{02)  =  s_PULSEG(02) 

CALL  RECEIVE_REAL_32BIT(  s_PULSEG{03)  ) 

PULSEG(03)  =  s_PULSEG(03) 

CALL  RECEIVE_REAL_64BIT (  XY7E(01)  ) 

CALL  RECEIVF._RF,AL_64BIT  (  XyZE{02)  ) 

CALL  RECEIVE_REAL_64BIT (  XYZE(03)  ) 

CALL  RECEIVE_REAL_64BIT (  XYZED(Ol)  ) 

CALL  RECEIVE_REAL  64BIT(  XYZED(02)  ) 

CALL  RECEIVE__REAL”64BIT(  XYZED(03),  ) 
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C - COMMUNICATION  WITH  SEEKER - C 

CALL  RECEIVE_REAL  64BIT(  X  ) 

CALL  RECEIVE_REAL"64BIT(  Y  ) 

CALL  RECEIVE_REAL_64BIT(  Z  ) 

CALL  RECEIVE  REAL_32BIT{  S_XD  ) 

CALL  RECEIVE  ■rEAL_32BIT{  S_YD  ) 

CALL  RECEIVE"REAL_32BIT(  S_ZD  ) 

XD  =  S_XD 
YD  =  S_YD 
ZD  ■=  S_ZD 

C - COMMUNICATION  WITH  CORVEL - C 

CALL  SEND_REAL_32BIT (  sngl(RMIR(l)  )) 

CALL  SEND_REAL_32BIT (  sngl(RMIR(2)  )) 

CALL  SEND_REAL_32BIT(  sngl(RMIR(3)  )) 

CALL  SEND_REAL_32BIT (  sngl{VMIR(l)  )) 

CALL  SEND_REAL_32EIT(  sngl(VMIR(2)  >) 

CALL  SEND_REAL_323IT(  sngl(VMIR(3)  )) 

CALL  RECEIVE_REAL_64BTT(  CRT (01, 01)  ) 

CALL  RECEIVE_REAL_64BIT (  GRT(01,02)  ) 

CALL  RECEIVE_REAL_64BIT (  GRT(01,03)  ) 

CALL  RECEIVE_REAL_64BIT(  RTIC(01,01)  ) 

CALL  RECEIVE_REAL_64BIT (  RTIC(01,02)  ) 

CALL  RECEIVE_REAL_64BIT (  RTIC(01,03)  ) 

CALL  RECEIVE_REAL_64BIT (  VTIC(01,01)  ) 

CALL  RECEIVE_REAL_64BIT (  VTIC(01,02)  ) 

CALL  RECEIVE_REAL_64BIT (  VTIC(01,03)  ) 

C -  COMMUNICATE  WITH  CORVEL  - C 

CALL  SEND  REAL_32BIT(  sngl{AT(01)  )) 

CALL  SEND~REAL_32BIT (  sngl(AT(02)  )) 

CALL  SEND_REAL_32BIT (  sngl(AT(03)  )) 

C -  DAISY  CHAIN  - C 


CALL  SEND_REAL_32BIT ( 
CALL  SEND_REAL_32BIT ( 
CALL  SEND_REAL_32BIT ( 
CALL  SEND_REAL_32BIT ( 
CALL  SEND_REAL_32BIT ( 
CALL  SEND_REAL_32BIT ( 
CALL  SEND_REAL_32BIT ( 
CALL  SEND_REAL_32BIT( 
CALL  SEND  REAL  32BIT( 


SNGL{TI2M(1) )  ) 
SNGL(TI2M(2) )  ) 
SNGL(TI2M(3) )  ) 
SNGL{TI2M(4) )  ) 
SNGL(TI2M(5) )  ) 
SNGL(TI2M(6) )  ) 
SNGL{TI2M(7) )  ) 
SNGL(TI2M(8) )  ) 
SNGL(TI2M(9) )  ) 


CALL 

CALL 

CALL 

CALL 

CALL 

CALL 


SEND_REAL_32BIT ( 
SEND_REAL_32BIT ( 
SEND_REAL_32BIT ( 
SEND_REAL_32BIT ( 
SEND_REAL_32BIT ( 
SEND  REAL  32BIT ( 


SNGL(VREL(1) ) 
SNGL(VREL(2) ) 
SNGL(VREL(3) ) 
SNGL(RREL(1)  ) 
SNGL(RREL(2) ) 
SNGL(RREL(3) ) 


) 

) 

) 

) 

) 

) 


CALL  SEND_REAL_32BIT {  SNGL(SP)  ) 
CALL  SEND_REAL_32BIT (  SNGL(SQ)  ) 
CALL  SEND_REAL  32BIT {  SNGL(SR)  ) 


INERTIAL  MEASUREMENT  UPDATE 
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C  Get  inertial  measurement  data  needed  C 

C  for  guidance  calculations  .  C 

C  C 

C - C 

IF  {  TSTEP  ,.GE.  TIMUDRIV  )  THEN 
TIMUDRIV  =  TIMUDRIV  +  TIMUSTEP 

C - C 

C - IMU  PROCESSOR  MODULE - C 

C - C 

C  Convert  gyro  and  accelerometer  outputs  C 

C  to  delta  angle  and  delta  velocity  C 

C  C 

C - C 

CALL  IMUPRO (T, PULSEG, PULSEA, DELPHI, DELTHT, DELPSI, 

DELU,DELV,DELW) 

C - C 

C - NAVIGATION  MODULE - C 

c - c 

C  This  module  calculates  the  quaternions  C 

C  and  transformation  matrices  using  delta  C 

C  angles  sensed  by  the  gyro  and  calculatesC 

C  the  interceptor  velocity  and  position  C 

C  using  delta  velocity  sensed  by  the  C 

C  accelerometer  C 

C  C 

C . - . - . c 

CALL  NAVIG (T, MASS, DELPHI, DELTHT, DELPSI, DELU, DELV, DELW,GR, 

QSl,  CIE,  SP,  SQ,  SR,  SUD,  SVD,  St'JD,  VMIR,  RMIR,  T12M,  SPHI,  STHT, 
SPSI,SU,SV,SW, AT,VMI,RMI) 

END  IF 

c - c 

c - MIDCOURSE  CORRECTION - C 

C - C 

C  Models  uplink  of  interceptor,  C 

C  target,  and  intercept  conditions  C 

C  C 

c - C 

IF  {  {  DABS(T-TUPLKl) .LE.DTEPS  )  .OR. 

*  (  DABS(T-TUPLK2) .LE.DTEPS  )  )  THEN 

C  REVISE  ESTIMATED  MISSILE  STATES 

VMI  (1)  =  XYZEDd) 

VMI (2)  =  XYZED (2) 

VMI (3)  =  XYZED (3) 

RMI (1)  =  XYZE(l) 

RMI(2)  =  XYZE{2) 

RMI(3)  =  XYZE(3) 
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VMIRd) 

52 

.XD 

VMIR(2) 

YD 

VMIR (3) 

3S 

ZD 

RMIRd) 

X 

RMIR(2) 

=2 

Y 

RMIR(3) 

s 

Z 

TONAV 

s 

T 

END  IF 


MIDCOURSE  CORRECTION 


Models  uplink  of  interceptor, 
target,  and  intercept  conditions 


IF  (  (  DABS(T-TUPLKl) .LE.DTEPS  )  .OR. 

(  DABS {T-TUPLK2) .LE.DTEPS  )  )  THEN 

REVISE  ESTIMATED  TARGET  STATES 


RTEST(l) 

RTEST{2) 

RTESTO) 

VTEST(l) 

VTEST(2) 

VTESTO) 

GRTEST(l) 

GRTEST(2) 

GRTESTO) 

TL2 


=  RTICd,  1) 
=  RTICd, 2) 
=  RTICd, 3) 

=  VTICd,l) 
=  VTICd,2) 
»=  VTICd,3) 

=  GRTd,l) 

=  GRTd,2) 

=  GRTd,3) 

=  T 


ENDIF 


ON  BOARD  GUIDANCE  PROCESSING 


Determine  guidance  commands 


IF  (  TSTEP  .GE.  TGPUDRIV  )  THEN 
TGPUDRIV  =  TGPUDRIV  +  TGPUSTEP 

-  ON  board  target  module  - 

Estimate  target  position  based  on 
predicted  intercept  conditions 
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C  GRTEST  TEMPORARILY  EQUAL  TO  GRT 

GRTESTd)  =  GRT(1,  1) 

GRTEST (2)  =  GRT (1,2) 

GRTEST (3)  =  GRT (1,3) 

CALL  OBTARG (T, GRTEST, RTEST, VTEST) 

CALL  ESTREL2 (RTEST, VTEST, RMIR, VMIR, RREL, VREL) 

ENDIF 


TERMINATION  LOGIC 


Defines  the  simulation  termination 
conditions 


INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 
lEXIT  =  0 

ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED 

IF  (  T.GE.TFINAL  )  THEN 
lEXIT  =  1 
ENDIF 

C  increment  time 

TSTEP  =  TSTEP  +  l.ODO 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
END 
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B.1.3  Uup02.for 

C  PROGRAM  EXOSIM 

C - 

C - Declare  and  initialize  variables  - 

C— - - 

IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

CHARACTER* 12 8  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCK  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RVCSTR  /  TREFLV  ,  TLSTV  ,  TMVCS  ,  THVCS  ,  LENVCS 

REAL  TMVCS (6, 4)  ,  THVCS (6, 4)  ,  DTOFFV(4) 

REAL  CG(3) 

REAL  TOFFLT(4) 

REAL  FOFFl(4)  ,  FOFF2{4) 

REAL  MXVCS  ,  MYVCS  ,  MZVCS 

REAL  MDOTV  , latlp, longlp 

INTEGER  LENVCS (4) 

INTEGER  SEKTYP 

REAL  TSTEP,DELT 
REAL  TMSUDRIV, TMSUSTEP 

double  precision  d_DTOFFV(4) 

double  precision  d_CG(3) 

double  precision  d_TOFFLT (4) ,d_tvtab 

double  precision  d_MXVCS  ,  d_MYVCS  ,  d_MZVCS 

double  precision  d_FXVCS  ,  d_FYVCS  ,  d_FZVCS 

double  precision  d_MDOTV  ,d_tburnm, d_timonv 

*  DATA  INITIALIZATION 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA3  5  .DAT  ' ) 

$  INCLUDE  { ’  -'/INCLUDE /SSDATA3  8  .DAT ' ) 

SINCLUDE  ( '  ''/INCLUDE/SSDATA39  .DAT  ' ) 

SINCLUDE  ( '  ''/INCLUDE/SSDATA42  .  DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA44  .DAT' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA45  .DAT  ' ) 

$ INCLUDE ( ' ^/INCLUDE/SSDATA46 .DAT ' ) 

$  INCLUDE  ( '  -'/ INCLUDE /SSDATA4  7  .DAT ' ) 

$  INCLUDE  ('-'/  INCLUDE  /  S  SDATA4  8  .  DAT ' ) 

SINCLUDE  ( '  ''/INCLUDE/SSDATA49 .  DAT ' ) 

$  INCLUDE  ( '  -'  /  INCLUDE  /  S  SDATA5  0  .  DAT ' ) 

$ INCLUDE ( ' ^ / INCLUDE / S  SDATAO 1 . D AT ' ) 

$  INCLUDE  ( '  -'/INCLUDE /SSDATAl  7  .DAT' ) 

$  INCLUDE  ( '  -'/INCLUDE /SSDATAl  8  .DAT ' ) 

$  INCLUDE  ( '  -'/ INCLUDE /SSDATA21  .DAT  ' ) 

$INCLUDE  ( '  •'/INCLUDE/SSDATA22  .DAT' ) 

$  INCLUDE  ( '  -'/ INCLUDE /SSDATA2  3  .DAT ' ) 

$  INCLUDE  ( '  -'/ INCLUDE /SSDATA2  8  .DAT  ' ) 

$  INCLUDE  ( '  -'  /  INCLUDE  /  S  SDAT  A2  9  .  D  AT ' ) 

$INCLUDE( '"/INCLUDE/SSDATA30.DAT' ) 

$  INCLUDE  ( '  -^  /  INCLUDE /SSDATA71  .DAT' ) 

SINCLUDE ( ' ^/INCLUUE/SSTIMING.DAT' ) 

$ INCLUDE ('SSp02.DAT') 

*  INITIALIZE  80x87 

CALL  CW87 
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MAIN  EXECUTION  LOOP 


Execution  of  all  events  is  performed 
within  this  loop 


LOGO  CONTINUE 


WRITE  (*,*)' - BEGINNING  OF  LOOP- 


MISSILE  STATE  UPDATE  MODULE 


Integrate  missile  states  to  current  time 


-  recieve  from  masspr  (POO)  - C 

CALL  RECEIVE_REAL_32BIT (  cg(Ol)  ) 

CALL  RECEIVE_REAL_32BIT (  cg(02)  ) 

CALL  RECEIVE_REAL_32BIT (  cg(03)  ) 

-  Send  variables  to  masspr  and  missil  (pOO) 

CALL  send_REAL_32BIT(  mdotV  ) 

CALL  send_REAL  32BIT (  fxvcs  ) 

CALL  send_REAL~32BIT(  fyves  ) 

CALL  send_REAL"32BIT(  fzves  ) 

CALL  send_REAL_32BIT (  mxvcs  ) 

CALL  send_REAL~32BIT (  myves  ) 

CALL  send  REAL  32BIT (  mzves  ) 


- Communication  with  pOl - C 

CALL  RECEIVE_REAL_32BIT(  DTOFFV(Ol)  ) 

CALL  RECEIVE_REAL_32BIT(  DTOFFV(02)  ) 

CALL  RECEIVE_REAL_32BIT(  DTOFFV(03)  ) 

CALL  RECEIVE_REAL_32BIT{  DTOFFV(04)  ) 

CALL  RECEIVE_SIGNED_16BIT(  IVCS  ) 

CALL  RECEIVE_SIGNED_16BIT(  IVTAB  ) 

CALL  RECEIVE_REAL_32BIT (  TBURNM  ) 

CALL  RECEIVE_REAL_32BIT(  TIMONV  ) 

CALL  RECEIVE_REAL_32BIT{  TOFFLT{01)  ) 

CALL  RECEIVE_REAL_32BIT {  TOFFLT{02)  ) 

CALL  RECEIVE_REAL_32BIT (  TOFFLT(03)  ) 

CALL  RECEIVE_REAL_32BIT (  TOFFLT(04)  ) 

CALL  RECEIVE_REAL_32BIT{  TVTAB  ) 

IF  (  tstep  .gE.  tmsudriv  )  THEN 

tmsudriv  ==  tmsudriv  +  tmsustep 


VeS  THRUSTER  RESPONSE  MODULE 
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Determines  the  forces  and  moments 
imparted  by  the  VCS  thrusters 


IF  (  T.GE.TKVON  )  THEN 

CALL  VCSTHR (T, CG, TBURNM, IVCS, TOFFLT, 

timonv,DTOFFV, TVTAB, FOFFl, FOFF2, IVTAB, TBRK, 
FXVCS, FYVCS, FZVCS, MXVCS, MYVCS, MZVCS, MDOTV) 


ENDIF 

ENDIF 


TERMINATION  LOGIC 


Defines  the  simulation  termination 
conditions 


C  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 
lEXIT  =  0 

C  increment  time 

TSTEP  =  TSTEP  +  1 . OeO 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
END 
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B.1.4  Uup03.for 

PROGRAM  EXOSIM 


Declare  and  initialize  variables 


C 

C 

C 


IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (0-Z) 

CHARACTER*128  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
COMMON  /  PTARG  /  TLl  ,  GRTLST  ,  FIRSTl 


REAL  CER(9) ,CIM(9) , Q, R, ZD, YD, XD, PTARG, QTARG, RTARG 
REAL  TPHI,TTHT,TPSI,TPHID,TTHTD,TPSID,CIT(9) ,CTI (9) 


DOUBLE 

PRECISION 

XINT(50) 

/ 

TINT (50) 

XDOTL(50) 

DOUBLE 

PRECISION 

SF1G(3) 

/ 

SF2G(3) 

DCG(3) 

DOUBLE 

PRECISION 

SF1A(3) 

/ 

SF2A{3) 

DCA(3) 

DOUBLE 

PRECISION 

OMEGAO (3) 

/ 

XYZLCH (3) 

EVTIME (20) 

DOUBLE 

PRECISION 

MASSL 

/ 

MACHL 

ANGACL(3,  4,  10) 

DOUBLE 

PRECISION 

OMEGAI (3) 

/ 

GRTLST (5, 3) 

CIMO(9) 

DOUBLE 

PRECISION 

WBI2 (3) 

t 

WBIl (3) 

WB02  (3) 

DOUBLE 

PRECISION 

WBOl (3) 

t 

GRLST(3) 

XYZDP (3) 

DOUBLE 

PRECISION 

ABI2 (3) 

9 

ABIl (3) 

AB02  (3) 

DOUBLE 

PRECISION 

ABOl (3) 

9 

GRLAST(3) 

GRTPST(3) 

DOUBLE 

PRECISION 

TLATCH(IO) 

9 

LAMMSV(2,10) 

RRELSV(3, 10) 

DOUBLE 

PRECISION 

VRELSV{3, 10) 

9 

TI2MSV(9,  10) 

SNRSV(IO) 

DOUBLE 

PRECISION 

AACCEL(3, 4) 

DOUBLE 

PRECISION 

CGX(20) 

9 

CGY{20) 

CGZ(20) 

DOUBLE 

P''RCISION 

MASST1(20) 

9 

MASST2 (20) 

REAn 

RANSEQ<97) 

9 

RANLST 

RAND1(98) 

INTEGER 

IEVFLG(20) 

9 

FIRSTl 

FIRST2 

INTEGER 

ISEQ(4) 

9 

IMCPAS (3,  4) 

FLIP 

INTEGER 

VCOD  ( 4 ) 

9 

GATE 

OUTPUTS 

DOUBLE 

PRECISION 

MXA 

9 

MYA 

MZA 

DOUBLE 

PRECISION 

MXT 

9 

MYI 

MZT 

DOUBLE 

PRECISION 

MRCX 

9 

MRCY 

MRCZ 

DOUBLE 

PRECISION 

MXVCS 

9 

MY^'CS 

MZVeS 

DOUBLE 

PRECISION 

MXACS 

9 

MYACS 

MZACS 

DOUBLE 

PRECISION 

MX 

9 

MY 

MZ 

DOUBLE 

PRECISION 

MACH 

9 

iiDOTT 

MDOTF 

DOUBLE 

PRECISION 

MDOTV 

9 

MDOTA 

LFRACS 

DOUBLE 

PRECISION 

KN 

9 

KM 

MDLTFR 

DOUBLE 

PRECISION 

KTHT 

9 

KTHTD 

MDELTA 

DOUBLE 

PRECISION 

KNE 

9 

KME 

tiALPHA 

DOUBLE 

PRECISION 

LATT 

9 

LONGT 

MVS 

DOUBLE 

PRECISION 

KA 

9 

KV 

MAGRTR 

DOUBLE 

PRECISION 

MAGLOS 

9 

MGRDTR 

MAGR 

DOUBLE 

PRECISION 

MAGV 

9 

MGRDOT 

MXYZDD 

DOUBLE 

PRECISION 

MGtl 

9 

LAT 

LONG 

DOUBLE 

PRECISION 

MISS 

9 

MVR 

MVRWM 

DOUBLE 

PRECISION 

ATKRF(4) 

9 

CMMD(2) 

VCMDL(4) 

DOUBLE 

PRECISION 

P.TER(3) 

9 

CMS (9) 
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DOUBLE 

PRECISION 

GRT(5,3) 

/ 

ADISTT(4,3) 

DOUBLE 

PRECISION 

RTAR(3) 

t 

VTAR(3) 

UVS'3) 

DOUBLE 

PRECISION 

VC{3) 

t 

DLV(3) 

VTTP  (3) 

DOUBLE 

PRECISION 

VS{3) 

t 

US  (3) 

AC(3) 

DOUBLE 

PRECISION 

CIR(9) 

/ 

CMI (9) 

DOUBLE 

PRECISION 

VW{3) 

/ 

WC{3) 

r 

PM(3) 

DOUBLE 

PRECISION 

CGEST(3) 

t 

RRELTRO) 

f 

VRELTP (3) 

DOUBLE 

PRECISION 

LAMTRU(2) 

/ 

LAMDXX(2) 

LAMDTR(2) 

DOUBLE 

PRECISION 

LAMSEK{2) 

/ 

LAMDSK(2) 

/ 

LAMM (2) 

DOUBLE 

PRECISION 

RTEST(3) 

RREL(3) 

URREL(3) 

DOUBLE 

PRECISION 

VREL(3) 

TI2M(9) 

USI  (3) 

DOUBLE 

PRECISION 

QS1{4) 

VMI (3) 

RMI  (3) 

DOUBLE 

PRECISION 

VMIR(3) 

t 

RMIR(3) 

VTEST(3) 

DOUBLE 

PRECISION 

AT  (3) 

t 

XYZR(3) 

r 

GB(3) 

DOUBLE 

PRECISION 

GR(3) 

i 

CRI(9) 

DOUBLE 

PRECISION 

VRWM(3) 

t 

CEI  (9) 

CIE(9) 

DOUBLE 

PRECISION 

PG(3) 

/ 

VTT(3) 

USO (3) 

DOUBLE 

PRECISION 

PG0(3) 

/ 

USF(3) 

QUATIC(4) 

DOUBLE 

PRECISION 

TI2MO(9) 

t 

GREST{3) 

DOUBLE 

PRECISION 

LAMMO(2) 

/ 

RRELO{3) 

VRELO(3) 

DOUBLE 

PRECISION 

RRELM(3) 

/ 

VRELM{3) 

GRTEST{3) 

DOUBLE 

PRECISION 

FOFFl  (4) 

/ 

FOFF2  (4) 

NAMELIST  INPUTS 

DOUBLE 

PRECISION 

I XX 

t 

lYY 

r 

IZZ 

DOUBLE 

PRECISION 

CG(3) 

i 

MASS 

r 

PQR(3) 

DOUBLE 

PRECISION 

IMPULS 

t 

QUAT(4) 

t 

MDOT 

DOUBLE 

PRECISION 

QUATD(4) 

t 

BOFF2  (2) 

t 

TMVeS (6, 4) 

DOUBLE 

PRECISION 

THVCS(6,4) 

t 

DTOFFV(4) 

t 

VG(3) 

DOUBLE 

PRECISION 

TMACSA(8,4) 

/ 

THACSA(8,4) 

t 

DTACSAi4) 

DOUBLE 

PRECISION 

TMACSB(8,4) 

/ 

THACSB(8,4) 

t 

DTACSB(4) 

DOUBLE 

PRECISION 

XYZE(3) 

t 

XYZED(3) 

f 

RTIC(5,3) 

DOUBLE 

PRECISION 

VTIC(5,3) 

t 

PULSEG(3) 

r 

QFRACG ( 3 ) 

DOUBLE 

PRECISION 

PULSEA(3) 

t 

QFRACA{3) 

t 

XYZEDD(3) 

DOUBLE 

PRECISION 

LAM (2) 

t 

LAMD(2) 

t 

VGM(3) 

DOUBLE 

PRECISION 

DTVeSP (3) 

r 

DTVCSY(3) 

t 

FLTC(4) 

DOUBLE 

PRECISION 

TOFFLT(4) 

t 

TMF(8, 4) 

t 

THF(8,4) 

DOUBLE 

PRECISION 

DTOFF  (4) 

t 

VWIC(3) 

t 

AOFFl (4) 

DOUBLE 

PRECISION 

VTTIC(3) 

f 

USD (3) 

t 

VCMD{4) 

DOUBLE 

PRECISION 

PGD(3) 

r 

VWD  (3) 

f 

MASSO 

DOUBLE 

PRECISION 

MSSTG2 

f 

LATLP 

r 

LONGLP 

DOUBLE 

PRECISION 

IMPLSO 

r 

MVRDOT 

DOUBLE 

PRECISION 

RJ(5) 

DOUBLE 

PRECISION 

AOFF2  (4) 

INTEGER 

LENVCS(4) 

/ 

LENA (4) 

t 

LENB(4) 

INTEGER 

LENF{4) 

t 

GYSEED 

r 

FRMCNT 

INTEGER 

SKSEED 

t 

SEKTYP 

t 

ACQD 

INTEGER 

TERM 

r 

TOSEED 

t 

VLVCM5 

INTEGER 

ESTATE 

INTEGER 

TRACK 

INTEGER 

ROWBEG 

t 

COLBEG 

r 

PLOTNO 

DOUBLE  PRECISION  TSTEP,DELT 

DOUBLE  PRECISION  TMSUDRIV, TTSUDRIV, TRSUDRIV, TIMUDRIV, 

*  TGPUDRIV, TAPUDRIV, TSPUDRIV, TKFUDRIV 
DOUBLE  PRECISION  TMSUSTEP, TTSUSTEP, TRSUSTEP, TIMUSTEP, 

*  TGPUSTEP,  'I'APUSTEP,  TSPUSTEP,  TKFUSTEP 
Integer  irst, jrst,krst 

*  DATA  INITIALIZATION 
$  INCLUDE  ( ' ''  /  INCLUDE  /  SSDATA3  5  .  DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA38  .DAT  ' ) 
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$  INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE { 
$ INCLUDE { 
$INCLUDE( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 
$ INCLUDE ( 


''/INCLUDE/SSDATA39.DAT' ) 
''/INCLUDE/SSDATA42  .  DAT ' ) 
''/INCLUDE/SSDATA44.DAT') 
INCLUDE /SSDATA4 5  .DAT  ’ ) 
''/INCLUDE/SSDi’'.TA4  6  .DAT ' ) 
''/ INCLUDE /SSDATA4 7  .DAT  ' ) 
-'/ INCLUDE /SSDATA4 8  .DAT' ) 
^/INCLUDE/SSDATA49.DAT') 
/ INCLUDE /SSDATA50  .DAT* ) 
''/ INCLUDE /SSDATAOl  .DAT ' ) 
''/INCLUDE/SSDATA17  .DAT') 
''/INCLUDE/SSDATA18  .  DAT  ' ) 
^/INCLUDE/SSDATA21.DAT') 
''/ INCLUDE /SSDATA2 2  .  DAT ' ) 
^/INCLUDE/SSDATA23 .DAT ' ) 
/  INCLUDE / SSDATA2  8  .  DAT ' ) 
/  INCLUDE / SSDATA2  9  .  DAT  ' ) 
''/INCLUDE/SSDATA30  .DAT ' ) 
''  /  INCLUDE /SSDATA7 1 .  DAT ' ) 
''/INCLUDE/SSTIMING  .  DAT  ' ) 


$ INCLUDE { ' ^ / INCLUDE /SSMAS_cg. DAT ' ) 

DATA  IMASS  ,  lAERO  ,  IBTHR  ,  IBAUTO  /  1,1,1,!/ 


*  INITIALIZE  80x87 
CALL  CW87 


$ INCLUDE ( ' SSp03 . DAT ' ) 


C - 

C - main  EXECUTION  LOOP - 

C- . . . - - - - - . . 

C  Execution  of  all  events  is  performed 

C  within  this  loop 


C 

C 


1000  CONTINUE 


C - 

C - Processor  communication 

C - 


C -  Communicate  with  pOO  — 

CALL  RECEIVE_REAL_32BIT(  Q  ) 

CALL  RECEIVE_REAL_32BIT(  R  ) 

CALL  RECEIVE_REAL_64BIT(  X  ) 

CALL  RECEIVE_REAL_64BIT (  Y  ) 

CALL  RECEIVE_REAL_64BIT (  Z  ) 

CALL  RECEIVE_REAL_32BIT (  XD  ) 

CALL  RECEIVE_REAL_32B1T (  YD  ) 

CALL  RECEIVE_REAL_32BIT (  ZD  ) 

CALL  RECEIVE_REAL_32BIT {  CIM(l)  ) 
CALL  RECEIVE_REAL_32BIT {  CIM(2)  ) 
CALL  RECEIVE_REAL_32DIT(  CIM(3)  ) 
CALL  RECEIVE_REAL_32BIT(  CIM(4)  ) 
CALL  RECEIVE_REAL_32BIT (  CIM{5)  ) 
CALL  RECEIVE_REAL_J2BIT (  CIM(6)  ) 
CALL  RECEIVE_REAL_32BIT(  CIM(7)  ) 
CALL  RECEIVE  REAL  3281'!  (  CIM(8)  ) 


C 
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CALL  RECEIVE  REAL  32BIT(  CIM(9)  ) 


C 


Communicate  with  pOl 


C 


CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 


SEND_REAL_64BIT (  CRT (01,01)  ) 
SEND_REAL_64BIT (  CRT (01, 02)  i 
SEND_REAL_64BIT (  CRT (01, 03)  ) 
SEND  SIGNED  16BIT(  IRESLV  ) 


SEND_REAL_32BIT ( 
SEND_REAL_32BIT ( 
SEND_REAL_32BIT ( 
SEND_REAL_32BIT( 
SEND_REAL_32BIT ( 
SEND_REAL_64BIT ( 
SEND_REAL_64BIT ( 
SEND_REAL_64BIT ( 
SEND_REAL_64BIT ( 
SEND_REAL_64BIT( 
SEND  REAL  64BIT ( 


SNGL(L?J4DXX(01)  ) 
SNGL(La>lDXX(02)  ) 
SNGL(LAMSEK(01) ) 
SNGL(LAMSEK(02) ) 
SNGL (MAGRTR)  ) 
RTIC(01,01)  ) 
RTIC(01,02)  ) 
RTIC(01,03)  ) 
VTIC(01,01)  ) 
VTIC(01,02)  ) 
VTIC(01,03)  ) 


) 

) 

) 

) 


C 


WRITE (*, *)  ' 


BEGINNING  OF  LOOP 


IF  (  tstep  .gE.  tmsudriv  )  THEN 
tmsudriv  =  tmsudriv  +  tmsustep 
C  ROTATING  EARTH  MODEL 


CALL  SPMMK(0.0E0, 1, 0 . OEO, 2, SNGL (OMEGAE*T) ,3,CER) 
END  IF 


RELATIVE  STATES  MODULE 


Calculate  relative  range,  range  rate, 
time-to-go,  LOS  angles  and  rates 


IF  (  TSTEP  .GE.  TRSUDRIV)  THEN 
TRSUDRIV  =  TRSUDRIV  +  TRSUSTEP 

CALL  RELAT (RTIC, VTIC, X, Y, Z, XD, YD, ZD, Q, R, CIM, CMS, RRELTR, 
MAGRTR, VRELTR,MGRDTR,MAGLOS, LAMTRU, LAMDXX, 
LAMDTR, LAMSEK, LAMDSK, TGOTR, RRELM, VRELM) 

EXTRAPOLATE  POINT  OF  CLOSEST  APPROACH 

XMISS  =  RRELTR (1)  +  TGOTR*VRELTR(l) 

YMISS  =  RRELTR (2)  +  TGOTR*VRELTR (2 ) 

ZMISS  =  RRELTR (3)  +  TGOTR*VRELTR (3) 

MISS  =  DSQRT  (  XMISS**2  +  YMISS**2  +  ZMISS**2  ) 

END  IF 


TARGET  STATES  MODULE 


This  module  calculates  the  true  exo- 
atmospheric  trajectory  data  for 


238 


on one  ooooooo 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


C  the  target  C 

C  C 

C - - - - - C 


IF  (  TSTEP  .GE.  TTSUDRIV  )  THEN 

TTSUDRIV  =  TTSUDRIV  +  TTSUSTEP 

CALL  TARGET (  T, MAGRTR, CER, CIE, PTARG, QTARG, RTARG, 

TPHI, TTHT, TPSI, GRT, TPHID, TTHTD, TPSID, CIT, RTIC, VTIC, 
RTAR, RTER, IRESLV, RJ, CTI, VTAR, LATT, LONGT  ) 


END  IF 


C - c 

C - TERMINATION  LOGIC - C 

C - c 

C  Defines  the  simulation  termination  C 

C  conditions  C 

C  C 

c - C 

C  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 

lEXIT  =  0 

C  ENABLE  EXIT  IF  INTERCEPT  HAS  OCCURRED  AND  ALL  EVENTS  SC»EDULED  FOR 

C  THIS  TIME  HAVE  BEEN  EXECUTED 


IF  (  TGOTR . LE . TGOMN  )  THEN 
lEXIT  =  1 
ENDIF 


C  increment  time 

TSTEP  =  TSTEP  +  l.ODO 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 

c - c 

C - POINT  OF  CLOSEST  APPROACH  CALCULATION  — C 

- - - 

C  Determines  the  miss  distance  at  the  C 

C  point  of  closest  approach  C 

C  C 

- - - 

MISS  =  DSQRT  (  (RRELTR(l)  +  VRELTR ( 1 ) *TGOTR) **2 
+  (RRELTR(2)  +  VRELTR (2 ) *TGOTR) * *2 
+  (RRELTRO)  +  VRELTRO)  *TGOTR)  **2  ) 


WRITE (MESSAGE, 889)  T,MISS 
CALL  OUTMES (MESSAGE) 

889  FORMATdX,  E16.9,  '  MISS  =  ',E16.9) 
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B.1.5  Uup04.for 

C  PROGRAM  EXOSIM 

C - 

C - Declare  and  initialize  variables 

C - 


IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (O-Z) 

CHARACTER* 12 8  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 


COMMON 

/  NORCOM  / 

GSET  , 

ISET 

COMMON 

/  RANCOM  / 

RANSEQ  , 

RANLST 

COMMON 

/  RGYRO  / 

PSIG  , 

THTG 

,  PHIG  , 

THXZG  , 

THXYG 

. 

THYZG  , 

THYXG 

,  THZYG  , 

THZXG  , 

SFIG 

. 

SF2G  , 

DCG 

,  TOGYRO  , 

CIMO  , 

WBI2 

• 

WBIl  , 

WB02 

,  WBOl  , 

DRSIGG 

REAL  S 

CIM(9) 

REAL  S“ 

‘P,S  Q,S  R 

double' 

'PRECISION 

SF1G(3) 

/ 

SF2G(3) 

,  DCG (3) 

REAL 

RANSEQ (97)  , 

RANLST 

DOUBLE 

PRECISION 

WBI2 (3) 

/ 

WBIl (3) 

,  WB02(3) 

DOUBLE 

PRECISION 

WBO"'  (3) 

DOUBLE 

PRECISION 

CIM(9) 

DOUBLE 

PRECISION 

PULSEG(3) 

DOUBLE 

PRECISION 

QFRACG(3) 

DOUBLE 

PRECISION 

LONGLP,  LATLP, 

CIMO(9) 

INTEGER* 4  GYSEED 
INTEGER  SEKTYP 


DOUBLE  PRECISION  TSTEP,DELT 
DOUBLE  PRECISION  TIMUDRIV, TIMUSTEP 


*  DATA  INITIALIZATION 

$include  ( '  ''/include/ssdataSS  .dat ' ) 
$include  ( '  ''/include/ssdataSS . dat ' ) 
$include  ( ' "/include/ssdataSS .dat ' ) 
Sinclude  ( '  ''/include/ssdata42  .dat ' ) 
$include  ( '  ''/include/ssdata44  .dat ' ) 
$include  ( '  ''/include/ssdata45  .dat ' ) 
$include  ( '  ''/include/ssdata46.dat ' ) 
Sinclude  { '  ''/include/ssdata47  .dat ' ) 
$include  ( ' ^/include/ssdata48 .d‘t ' ) 
Sinclude  ( '  ''/include/ssdaca49  .dat ' ) 
Sinclude  ( '  ''/include/ssdataSO  .dat ' ) 
Sinclude  ( '  ''/include/ssdataOl  .dat ' ) 
Sinclude  ( '  ''/include/ssdatall  .dat ' ) 
Sinclude  ( '  ''/include/ssdatal8  .dat ' ) 
Sinclude  { '  ''/incl-ade/ssdata21  .dat ' ) 
Sinclude  ( '  ''/include/ssdata22  .dat ' ) 
Sinclude  ( ' "/include/ssdataZS .dat ' ) 
Sinclude  ( '  ''/include/ssdata28  .dat ' ) 
Sinclude  ( '  ''/include/ssdaLa29.dat ' ) 
Sinclude  ( '  "'/include/ssdataSO .dat ' ) 
Sinclude  ( '  ''/include/ssdataTl  .dat ' ) 
Sinclude  ( '  ''/include/sstiming .  dat ' ) 
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call  cw87 

$include  ('ssp04.dat') 


MAIN  EXECUTION  LOOP 


Execution  of  all  events  is  performed 
within  this  loop 


LOGO  CONTINUE 


WRITE (*,*)  ' 


BEGINNING  OF  LOOP 


Processor  communication 


-  Communicate  with  pOl  - 

CALL  SEND_REAL_32BIT (  SNGL (PULSEG (01) )  ) 
CALL  SEND_REAL_32BIT (  SNGL (PULSEG (02) )  ) 
CALL  SEND  REAL  32BIT(  SNGL (PULSEG (03) )  ) 


CALL  RECEIVE_REAL_32BIT(  S_P  ) 
CALL  RECEIVE  REAL_32BIT(  S_Q  ) 
CALL  RECEIVE"REAL_32BIT (  S_R  ) 
P  =  DBLE(S_P) 

Q  =  DBLE(S_Q) 

R  =  DBLE(S  R) 


CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT( 
CALL  RECEIVE_REAL_32BIT( 
CIM(l)  =  DBLE(S_CIM(1) ) 
CIM(2)  =  DBLE(S_CIM(2) ) 
CIM(3)  =  DBLE(S_CIM(3) ) 
CIM(4)  =  DBLE(S_CIM(4) ) 
CIM(5)  =  DBLE(S_CIM(5) ) 
CIM(6)  =  DBLE(S_CIM(6) ) 
CIM(7)  =  DBLE(S_CIM(7) ) 
CIM(8)  =  DBLE(S_CIM(8) ) 
CIM(9)  =  DBLE(S  CIM(9) ) 


S_CIM(1)  ) 
S_CIM(2)  ) 
S_CIM(3)  ) 
S_CIM(4)  ) 
S_CIM(5)  ) 
S_CIM(6)  ) 
S_CIM(7)  ) 
S_CIM(8)  ) 
S  CIM(9)  ) 


INERTIAL  MEASUREMENT  UPDATE 


Get  inertial  measurement  data  needed 
for  guidance  calculations  . 
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IF  {  TSTEP  .GE.  TIMUDRIV  )  THEN 
TIMUDRIV  =  TIMUDRIV  +  TIMUSTEP 

C - C 

c - gyro  module - c 

c - c 

C  Determine  sensed  body  rates  .  C 

C  C 

C - C 

CALL  GYRO (T, P, Q, R, CIM, GYSEED, QFRACG, PULSEG) 

END  IF 

C - C 

C - TERMINATION  LOGIC - C 

C - C 

C  Defines  the  simulation  termination  C 

C  conditions  C 

C  C 

C - C 

C  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 

lEXIT  =  0 

C  increment  time 

TSTEP  =  TSTEP  +  l.OdO 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
END 
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B.1.6  UupOS.for 

PROGRAM  EXOSIM 


Declare  and  initialize  variables 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

CHARACTER* 12 8  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCK  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  NORCOM  /  GSET  ,  ISET 

COMMON  /  RANCOM  /  RANSEQ  ,  RANLST 

COMMON  /  RACSTR  /  TREFLA  ,  TLSTC  ,  ACSF  ,  AOFFl  ,  AOFF2  , 

TMACSA  ,  THACSA  ,  LENA  ,  TMACSB  ,  THACSB  , 

LENB 

REAL  CG(3) 

REAL  MXACS  ,  MYACS  ,  M2ACS  ,  MDOTA 

REAL  RANSEQ (97)  ,  RANLST, AOFF2 (4) ,  AOFFl (4) 

REAL  TMACSA(8,4)  ,  THACSA(8,4)  ,  DTACSA(4) 

REAL  TMACSB(8,4)  ,  THACSB(8,4)  ,  DTACSB(4) 

double  precision  d_cg(3) 

double  precision  d_MXACS,  d_MYACS,  d_MZACS,  d_MDOTA 
double  precision  d_fxacs,d_fyacs,d_fzacs 
double  precision  d_acslev,d_dtacsa (4) , d_dtacsb (4) 
double  precision  d_tatab 

INTEGER  LENA (4)  ,  L^NB{4) 

INTEGER  SEKTYP 

INTEGER* 4  TOSEED 

REAL  TSTEP,DELT,latlp,longlp 
REAL  TMSUDRIV,  TMSUSTEP 

*  DATA  INITIALIZATION 
$  INCLUDE  ( '  ''/INCLUDE /SSDATA3  5  .DAT' ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA3  8  .DAT ' ) 

$INCLUDE ( '  '7INCLUDE/SSDATA39 .DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA4  2  .DAT ' ) 

$  INCLUDE  C''/ INCLUDE /SSDATA4  4  .DAT' ) 

SINCLUDE  ( '  ''/INCLUDE/SSDATA45  .DAT' ) 

SINCLUDE  { ' '' /INCLUDE/SSDATA4  6 .  DAT ' ) 

$  INCLUDE  ( '  -'/INCLUDE/ SSDATA4  7  .DAT  ' ) 

$ INCLUDE ( ' ^ / INCLUDE /SSDATA4 8 .DAT ' ) 

$  INCLUDE  ( '  -'/ INCLUDE /SSDATA4  9  .DAT  ' ) 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA50  .DAT  ' ) 

$  INCLUDE  ( ' ''  /  INCLUDE/SSDATAO 1 .  DAT  ' ) 

$ INCLUDE { ' ^/INCLUDE /SSD AT A1 7 .DAT ' ) 

$  INCLUDE  { '  ''/INCLUDE/SSDATA18  .DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA21  .DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA2  2  .DAT ' ) 

SINCLUDE  ( '  ''/INCLUDE/SSDATA23  .DAT ' ) 

$ INCLUDE ( ' "/ INCLUDE /SSDATA2 8 .DAT ' ) 

$  INCLUDE  ( ' ''  /  INCLUDE  /  S  SDATA2  9  .  D  AT  ' ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA30  .DAT ' ) 

$  INCLUDE  ( ' ''  /  INCLUDE  /  S  SDATA7 1 .  DAT  ' ) 

$INCLUDE  { '  ''/INCLUDE/SSTIMING .  DAT ' ) 
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*  INITIALIZE  80x87 
CALL  CW87 

C  DETERMINE  IF  MIDFLIGHT  RESTART 
$ INCLUDE { ' SSpOS . DAT ' ) 


MAIN  EXECUTION  LOOP 


Execution  of  all  events  is  performed 
within  this  loop 


l':0  CONTINUE 


WRITE  (*,*)  ' - BEGINNING  OF  LOOP 


MISSILE  STATE  UPDATE  MODULE 


Integrate  missile  states  to  current  time 


C -  recieve  from  masspr  (POO)  - C 

CALL  RECEIVE_REAL_32BIT (  cg(Ol)  ) 

CALL  RECEIVE_REAL_32BIT<  cg(02)  ) 

CALL  RECEIVE_REAL_32BIT<  cg(03)  ) 

C - Send  variables  to  masspr  and  missil  (pOO)  - C 

CALL  send_REAL_32BIT (  mdota  ) 

CALL  send_REAL_32BIT (  fxacs  ) 

CALL  send_REAL_32BIT (  fyacs  ) 

CALL  send_REAL_32BIT(  fzacs  ) 

CALL  send_REAL_32BIT(  mxacs  ) 

CALL  send_REAL_32BIT (  myacs  ) 

CALL  send  REAL  32BIT(  mzacs  ) 


C - Communication  with  pOl - C 

CALL  RECEIVE_REAL_32BIT {  ACSLEV  ) 

CALL  RECEIVE_REAL_32BIT(  DTACSA(Ol)  ) 

CALL  RECEIVE_REAL_32BIT(  DTACSA(02)  ) 

CALL  RECEIVE_REAL_32BIT (  DTACSA(03)  ) 

CALL  RECEIVE_REAL_32BIT (  DTACSA(04)  ) 

CALL  RECEIVE_REAL_32BIT(  DTACSB(Ol)  ) 

CALL  RECEIVE_REAL_32BIT(  DTACSB(02)  ) 

CALL  RECEIVE_REAL_32BIT (  DTACSB(03)  ) 

CALL  RECEIVE_REAL_32BIT (  DTACSB(04)  ) 

CALL  RECEIVE_SIGNED_16BIT(  ITHRES  ) 

CALL  RECEIVE_REAL_32BIT(  TATAB  ) 

CALL  SEND_SIGNED  16BIT(  lACSON  ) 
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IF  {  tstep  .gE.  tmsudriv  )  THEN 
tmsudriv  =  tmsudriv  +  tmsustep 

IF  (  T.GE.TKVON  )  THEN 


ACS  THRUSTER  RESPONSE  MODULE 


Determines  the  forces  and  moments 
imparted  by  the  ACS  thrusters 


CALL  ACSTHR (T, CG, ACSLEV, DTACSA, DTACSB, TATAB, TOSEED, 

tbrk, ITHRES,FXACS,FYACS,FZACS,MXACS,MYACS,MZACS, 
MDOTA, IACSON,TIMONA) 

END  IF 
END  IF 


TERMINATION  LOGIC  - 

Defines  the  simulation  termination 
conditions 


C  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 
lEXIT  =  0 

C  increment  time 

TSTEP  =  TSTEP  +  l.OeO 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
END 
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B.1.7  Uup06.for 

C  PROGRAM  EXOSIM 

C - 

C - Declare  and  initialize  variables 

C - 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

CHARACTER* 12 8  MESSAGE 

real  CGX(20)  ,  CGy(20)  ,  CGZ(20) 

real  MASST1{20) 

real  CG(3)  ,  MASS 

INTEGER  iexit  ,  icg 

real  TSTEP,DELT 
real  TMSUDRIV, TMSUSTEP 

*  DATA  INITIALIZATION 

$  INCLUDE  ( ' ''  /  INCLUDE  /  SSMAS_cg .  DAT  ' ) 

*  INITIALIZE  80x87 

CALL  CW87 

C  RESTARTING  FROM  MIDFLIGHT  DATA  FILE 

$ INCLUDE ('SSp06.DAT') 


C - 

C - main  EXECUTION  LOOP - 

C”“”~“ - - - - - - - - - - - 

C  Execution  of  all  events  is  performed 

C  within  this  loop 

C 

C - 


1000  CONTINUE 


C  WRITE  (*,*)' - BEGINNING  OF  LOOP - ' 

C - 

C - MISSILE  STATE  UPDATE  MODULE - 

C - 

C  Integrate  missile  states  to  current  time 

C 

C - 


IF  (  tstep  .gE.  tmsudriv  )  THEN 
tmsudriv  =  tmsudriv  +  tmsustep 


dt  =  tmsustep  *  delt 

C - 

- MASS  PROPERTIES  MODULE 

C - 

C  Update  eg 

C 

C - 
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C  CALCULATE  MISSILE  CENTER  OF  GRAVITY  COMPONENTS 

CALL  spTABLE (MASST1,CGX,MASS,CG(1) , 20, ICG) 

CALL  spTABLE (MASSTl , CGY, MASS, CG (2) , 20, ICG) 

CALL  spTABLE (MASSTl, CGZ, MASS, CG(3) , 20, ICG) 

END  IF 

C - C 

C - Processor  comnrunication - C 

C - C 

c -  communication  with  missil  model 

call  receive_real_32bit (  mass  ) 

C -  send  to  ACSTHR  and  VCSTHR  and  ACCEL 

CALL  send_REAL_32BIT {  eg (01)  ) 

CALL  send_REAL_32BIT(  cg{02)  ) 

CALL  send_REAL_32BIT (  eg (03)  ) 

C - C 

C - OUTPUT  MODULE - C 

C - C 

C  Creates  print  and  plot  output  data  C 

C  files  C 

C  C 

C - C 

C  if  (  mod(idnint (tstep)  ,idnint(dtprt) ) .eq.O  )  then 

C  END IF 

Q _ C 

C - TERMINATION  LOGIC - C 

C - - - . . . C 

C  Defines  the  simulation  termination  C 

C  conditions  C 

C  C 

C - c 

C  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 

lEXIT  =  0 

C  increment  time 

TSTEP  =  TSTEP  +1.0 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
END 
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B.1.8  Uup07.for 


C  PROGRAM  EXOSIM 

C - 

C - Declare  and  initialize  variables 

C - 


C - 

IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

CHARACTER* 12 8  MESSAGE 

REAL  TSTEP,DELT 

REAL  TIMUDRIV, TIMUSTEP, TGPUDRIV, TGPUSTEP 

REAL  MVR  ,  MVS 

REAL  VS (3)  ,  VTT(3) 

real  vc(3)  ,  uvs(3) 

REAL  X,Y,Z,XD,YD,ZD 
REAL  RMIR(3) ,VMIR(3) 

REAL  LONGLP,  LATLP 
INTEGER  SEKTYP 

*  DATA  INITIALIZATION 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA35  .DAT ' ) 

SINCLUDE  ( '  ‘'/INCLUDE/SSDATA38  .DAT  ' ) 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA3  9  .DAT  ' ) 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA4  2  .DAT  • ) 

$  INCLUDE  ( '  -^  /  INCLUDE/SSDATA4  4  .  DAT  • ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA4  5  .DAT  ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA46  .DAT' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA47  .DAT ' ) 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA4  8  .DAT ' ) 

$  INCLUDE  ( ' ''  /  INCLUDE  /  SSDATA4  9  .  D  AT ' ) 

$INCLUDE(  '''/INCLUDE/SSDATA50.DAT' ) 

$  INCLUDE  { ' ''/ INCLUDE /SSDATAOl  .DAT ' ) 

$ INCLUDE ( ' ^/INCLUDE/SSDATA17 .DAT ' ) 

$  INCLUDE  ( '  -'/ INCLUDE /SSDATAl  8  .DAT' ) 

$  INCLUDE  ( '  -'  /  INCLUDE/SSDATA2 1 .  DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA22  .DAT' ) 

$  INCLUDE  ( '  -'/INCLUDE /SSDATA2  3  .DAT ' ) 

$  INCLUDE  ( '  -'/ INCLUDE /SSDATA2  8  .DAT ' ) 

$  INCLUDE  ( '  -'/ INCLUDE /SSDATA2  9 .  DAT ' ) 

$  INCLUDE  { '  -'/INCLUDE /SSDATA30  .DAT' ) 

$  INCLUDE  { '  -'/ INCLUDE /SSDATA71  .DAT  ’ ) 

$  INCLUDE  ( '  -'/INCLUDE/ SSTIMING.DAT  ' ) 

*  INITIALIZE  80x87 

CALL  CW87 

$ INCLUDE { ' SSp07 . DAT ' ) 


C - 

c - main  execution  loop  - 

r -  _  _ _ 

C  Execution  of  all  events  is  performed 

C  within  this  loop 

C 

C - 


,  VTTP(3),  AT (3) 

,  VG(3)  ,  US(3) 

/  dlv(3) 
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C  CALL  1NITIALIZE_TIMING() 

1000  CONTINUE 


C  CALL  START  TIMING (0) 


C  WRITE(*,*)' - BEGINNING  OF  LOOP 

C - 

C - Processor  communication 

C - 


C 

■C 

■c 


C  CALL  SWITCH_TIMING() 

C - COMMUNICATION  WITH  POO - C 


CALL  RECEIVE_REAL_32BIT {  X  ) 
CALL  RECEIVE_REAL_32BIT (  Y  ) 
CALL  RECEIVE_REAL_32BIT(  Z  ) 
CALL  RECEIVE_REAL_32BIT (  XD  ) 
CALL  RECEIVE_REAL_32BIT (  YD  ) 
CALL  RECEIVE  REAL  32BIT(  ZD  ) 


CALL  RECEIVE_REAL_32BIT (  RMIR(l)  ) 
CALL  RECEIVE_REAL_32BIT (  RMIR(2)  ) 
CALL  RECEIVE_REAL_32BIT(  RMIR(3)  ) 
CALL  RECEIVE_REAL_32BIT (  VMIR(l)  ) 
CALL  RECEIVE  REAL_32Bir(  VMIR(2)  ) 
CALL  RECEIVE“REAL  32B1T {  VMIR(3)  ) 


C 


COMMUNICATION  WITH  POl 


"C 


CALL  RECEIVE  REAL_32BIT (  at(l)  ) 
CALL  RECEIVE~REAL_32BIT (  at  (2)  ) 
CALL  RECEIVE“REAL_32BIT (  at (3)  ) 
CALL  SEND  REAL_32BIT(  VG{1)  ) 
CALL  SEND~REAL  32BIT (  VG<2)  ) 
CALL  SEND  REAL  ■32BIT (  VG(3)  ) 


C  CALL  SWITCH_TIMING() 

C - C 

C - INERTIAL  MEASUREMENT  UPDATE - C 

C - C 

C  Get  inertial  measurement  data  needed  C 

C  for  guidance  calculations  .  C 

C  C 

C - C 


IF  (  TSTEP  .GE.  TIMUDRIV  )  THEN 
TIMUDRIV  =  TIMUDRIV  +  TIMUSTEP 
C  TIME  SINCE  LAST  INERTIAL  MEASUREMENT  UPDATE 


DT  =  TIMUSTEP 

C  INTEGRtiTE  GRAVITY 

VTT{1)  =  VTT{1)  + 
VTT(2)  =  VTT(2)  + 
VTT(3)  =  VTT(3)  + 


*  DELT 

COMPENSATED  ACCELERATION 

DT*AT (1) 

DT*AT{2) 

DT*AT(3) 
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ENDIF 

C - C 

C - MIDCOURSE  CORRECTION - C 

C - C 

C  Models  uplink  of  interceptor,  C 

C  target,  and  intercept  conditions  C 

C  C 

C - C 

IF  (  (  ABS (T-TUPLKl) .LE.DTEPS  )  .OR. 

*  (  ABS (T-TUPLK2) .LE.DTEPS  )  >  THEN 

C  REVISE  ESTIMATED  MISSILE  STATES 

VMIR(l)  =  XD 

VMIR(2)  =  YD 

'mR(3)  =  ZD 

RMIR(l)  =  X 

RMIR(2)  =  Y 

RMIR(3)  =  Z 

ENDIF 

C - C 

C  ON  BOARD  GUIDANCE  PROCESSING  C 

C - c 

C  Determine  guidance  commands  C 

C  C 

C - c 

IF  (  TSTEP  .GE.  TGPUDRIV  )  THEN 
TGPUDRIV  =  TGPUDRIV  +  TGPUSTEP 

C - C 

C -  CORRELATED  VELOCITY  MODULE  - C 

C - C 

C  This  section  calculates  the  correlated  C 

C  velocity  vector  (VC)  through  an  iter-  C 

C  ative  process.  From  VC,  the  steering  C 

C  velocity  vector  is  produced  by  sub-  C 

C  tracting  a  bias  velocity  (VDO)  from  the  C 

C  velocity  to  be  gained  (VG) .  C 

C  C 

C - C 


IF  (  T.GE.TCORV  .AND.  T . LE . (TTF-DTSPVC)  )  THEN 

CALL  CORVEL (T, MVR, VTT, RMIR, VMIR, VTTP, VG, VS, M 
DLV, TFFE, TTFE) 

DTMPl  =  DTCVU  *  ANINT  (  (T+DTCVU)  /  DTCVU  ) 
TCORV  =  DTMPl 
ENDIF 


251 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 

END  IF 

C - C 

C - OUTPUT  MODULE - C 

C - C 

c  call  stop_timing 0 

c  if  <  moddnt  (tstep) ,  int  (dtprt) )  .eq.O  )  then 

c  call  output_timing() 

c  call  INITIALIZE_TIMINGO 

C  ENDIF 

C - C 

C -  TERMINATION  LOGIC  - C 

C - C 

C  Defines  the  simulation  termination  C 

C  conditions  C 

C  C 

c - c 

C  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 

lEXIT  =  0 

C  ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
C  EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED 

IF  (  T.GE.TFINAL  )  THEN 
lEXIT  =  1 
ENDIF 

C  increment  time 

TSTEP  =  TSTEP  +  l.ODO 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
END 
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B.1.9  UupOS.for 

PROGRAM  EXOSIM 

-  Declare  and  initialize  variables 


IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (O-Z) 

CHARACTER* 12 8  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  STORAG  /  XINT  ,  TINT  ,  XDOTL 
COMMON  /  RMISSL  /  XYZLCH 


REAL  S_MASS, S_CIM (9) , S_FXACS, S_FYACS, S_FZACS 
REAL  S_FXVCS,S_FYVCS,S_FZVCS 


DOUBLE 

PRECISION 

XINT(50) 

/ 

TINT(50) 

/ 

XDOTL (50) 

DOUBLE 

PRECISION 

SF1G(3) 

/ 

SF2G(3) 

t 

DCG(3) 

DOUBLE 

PRECISION 

SF1A(3) 

/ 

SF2A(3) 

t 

DCA(3) 

DOUBLE 

PRECISION 

OMEGAO (3) 

/ 

XYZLCH (3) 

t 

EVTIME(20) 

DOUBLE 

PRECISION 

MASSL 

t 

MACHL 

t 

ANGACL(3, 4, 10) 

DOUBLE 

PRECISION 

OMEGAI (3) 

t 

GRTLST(5,3) 

t 

CIMO(9) 

DOUBLE 

PRECISION 

WBI2 (3) 

t 

WBIl  (3) 

t 

WB02 (3) 

DOUBLE 

PRECISION 

WBOl (3) 

i 

GRLST(3) 

t 

XYZDP (3) 

DOUBLE 

PRECISION 

ABI2 (3) 

t 

ABIl  (3) 

! 

AB02 (3) 

DOUBLE 

PRECISION 

AB01(3) 

t 

GRLAST(3) 

t 

GRTPST(3) 

DOUBLE 

PRECISION 

TLATCH(IO) 

/ 

LAMMSV(2,10) 

t 

RRELSV(3, 10) 

DOUBLE 

PRECISION 

VRELSV(3,10) 

t 

TI2MSV(9, 10) 

t 

SNRSV(IO) 

DOUBLE 

PRECISION 

AACCEL(3,4) 

DOUBLE 

PRECISION 

CGX(20) 

t 

CGY(20) 

r 

CGZ(20) 

DOUBLE 

PRECISION 

MASSTl (20) 

t 

MASST2 (20) 

REAL 

RANSEQ(97) 

t 

RANLST 

r 

RANDl (98) 

INTEGER 

IEVFLG(20) 

r 

FIRSTl 

r 

FIRST2 

INTEGER 

ISEQ(4) 

r 

IMCPAS(3,  4) 

t 

FLIP 

INTEGER 

VCOD(4) 

t 

GATE 

OUTPUTS 

DOUBLE 

PRECISION 

MXA 

r 

MYA 

f 

MZA 

DOUBLE 

PRECISION 

MXT 

t 

MYT 

t 

MZT 

DOUBLE 

PRECISION 

MRCX 

r 

MRCY 

r 

MRCZ 

DOUBLE 

PRECISION 

MXVCS 

r 

MYVeS 

t 

MZVeS 

DOUBLE 

PRECISION 

MXACS 

r 

MYACS 

r 

MZACS 

DOUBLE 

PRECISION 

MX 

t 

MY 

t 

MZ 

DOUBLE 

PRECISION 

MACH 

t 

MDOTT 

f 

MDOTF 

DOUBLE 

PRECISION 

MDOTV 

r 

MDOTA 

t 

LFRACS 

DOUBLE 

PRECISION 

KN 

r 

KM 

t 

MDLTFR 

DOUBLE 

PRECISION 

KTHT 

f 

KTHTD 

t 

MDELTA 

DOUBLE 

PRECISION 

KNE 

r 

KME 

f 

I-IALPHA 

DOUBLE 

PRECISION 

LATT 

/ 

LONGT 

t 

MVS 

DOUBLE 

PRECISION 

KA 

r 

KV 

t 

MAGRTR 

DOUBLE 

PRECISION 

MAGLOS 

f 

MGKDTK 

r 

.’-lAGR 

DOUBLE 

PRECISION 

MAGV 

/ 

MGRDOT 

t 

MXYZDD 

DOUBLE 

PRECISION 

MGR 

r 

LAT 

t 

LONG 

DOUBLE 

PRECISION 

MISS 

r 

MVR 

/ 

MVRWM 

DOUBLE 

PRECISION 

ATHRF (4) 

/ 

CMMD (2) 

/ 

VCMDL(4) 
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DOUBLE 

PRECISION 

RTER(3) 

/ 

CTI (9) 

9 

CMS (9) 

DOUBLE 

PRECISION 

CIT{9) 

/ 

GRT{5,3) 

9 

ADISTT(4,3) 

DOUBLE 

PRECISION 

RTAR(3) 

/ 

VTAR(3) 

9 

UVS(3) 

DOUBLE 

PRECISION 

VC  (3) 

t 

DLV{3) 

9 

VTTP (3) 

DOUBLE 

PRECISION 

VS  (3) 

t 

US(3) 

9 

AC(3) 

DOUBLE 

PRECISION 

CIRO) 

/ 

CIM(9) 

9 

CMI (9) 

DOUBLE 

PRECISION 

VW(3) 

/ 

WC{3) 

9 

PM(3) 

DOUBLE 

PRECISION 

CGEST(3) 

/ 

RRELTR(3) 

VRELTR(3) 

DOUBLE 

PRECISION 

LAMTRU(2) 

/ 

LAMDXX(2) 

LAMDTR(2) 

DOUBLE 

PRECISION 

LAMSEK{2) 

LAMDSK{2> 

LAMM(2) 

DOUBLE 

PRECISION 

RTEST{3) 

RREL(3) 

URREL ( 3 ) 

DOUBLE 

PRECISION 

VREL(3) 

/ 

TI2M(9) 

USI  (3) 

DOUBLE 

PRECISION 

QS1(4) 

/ 

VMI(3) 

9 

RMI (3) 

DOUBLE 

PRECISION 

VMIR(3) 

/ 

kMIR(3) 

9 

VTEST(3) 

DOUBLE 

PRECISION 

AT{3) 

XYZR(3) 

GB(3) 

DOUBLE 

PRECISION 

GR(3) 

t 

CER(9) 

CRI (9) 

DOUBLE 

PRECISION 

VRWM{3) 

/ 

CEI(9) 

9 

CIE(9) 

DOUBLE 

PRECISION 

PG(3) 

r 

VTT<3) 

9 

US0(3) 

DOUBLE 

PRECISION 

PG0(3) 

t 

USF(3) 

9 

QUATIC(4) 

DOUBLE 

PRECISION 

TI2MO(9) 

GREST(3) 

DOUBLE 

PRECISION 

LAMMO(2) 

RRELO(3) 

VRELO(3) 

DOUBLE 

PRECISION 

RRELM(3) 

/ 

VRELM(3) 

GRTEST (3) 

DOUBLE 

PRECISION 

FOFFl  (4) 

/ 

FOFF2 (4) 

NAMELIST  INPUTS 

DOUBLE 

PRECISION 

I XX 

/ 

lYY 

9 

IZZ 

DOUBLE 

PRECISION 

CG(3) 

/ 

MASS 

9 

PQR(3) 

DOUBLE 

PRECISION 

IMPULS 

t 

QUAT(4) 

9 

MDOT 

DOUBLE 

PRECISION 

QUATD(4) 

BOFF2 (2) 

9 

TMVCS(6,4) 

DOUBLE 

PRECISION 

THVCS(6,4) 

DTOFFV(4) 

9 

VG(3) 

DOUBLE 

PRECISION 

TMACSA(8,4) 

t 

THACSA(8,4) 

9 

DTACSA(4) 

DOUBLE 

PRECISION 

TMACSB(8,4) 

t 

THACSB(8,4) 

9 

DTACSB(4) 

DOUBLE 

PRECISION 

XYZE(3) 

t 

XYZED(3) 

9 

RTIC{5,3) 

DOUBLE 

PRECISION 

VTIC(5,3) 

9 

PULSEG{3) 

9 

QFRACG(3) 

DOUBLE 

PRECISION 

PULSEAO) 

9 

QFRACA(3) 

9 

XYZEDD(3) 

DOUBLE 

PRECISION 

LAM(2) 

9 

LAMD (2) 

9 

VGM(3) 

DOUBLE 

PRECISION 

DTVCSP (3) 

9 

DTVCSY(3) 

9 

FLTC(4) 

DOUBLE 

PRECISION 

TOFFLT(4) 

9 

TMF(8,4) 

9 

THF(8,4) 

DOUBLE 

PRECISION 

DTOFF (4) 

9 

VWIC(3) 

9 

AOFFl (4) 

DOUBLE 

PRECISION 

VTTIC(3) 

9 

USD (3) 

9 

VCMD ( 4 ) 

DOUBLE 

PRECISION 

PGD{3) 

9 

VWD(3) 

9 

MASSO 

DOUBLE 

PRECISION 

MSSTG2 

9 

LATLP 

9 

LONGLP 

DOUBLE 

PRECISION 

IMPLSO 

9 

MVRDOT 

9 

CAZ(IOO) 

DOUBLE 

PRECISION 

CEL(IOO) 

9 

RJ(5) 

DOUBLE 

PRECISION 

AZSUB(IOO) 

9 

ELSUB(IOO) 

9 

RJSUB(IOO) 

DOUBLE 

PRECISION 

AOFF2  (4) 

INTEGER 

LENVCS(4) 

9 

LENA (4) 

9 

LENB(4) 

INTEGER 

LENF  ( 4 ) 

9 

GYSEED 

9 

FRMCNT 

INTEGER 

SKSEED 

9 

SEKTYP 

ACQD 

INTEGER 

TERM 

9 

TOSEED 

9 

VLVCM5 

INTEGER 

ESTATE 

INTEGER 

TRACK 

INTEGER 

ROV7BEG 

9 

COLBEG 

9 

PLOTNO 

DOUBLE  PRECISION  TSTEP,DELT 

DOUBLE  PRECISION  TMSUDRIV, TTSUDRIV, TRSUDRIV, TIMUDRIV, 

*  TGPUDRIV, TAPUDRIV, TSPUDRIV, TKEUDRIV 
DOUBLE  PRECISION  TMSUSTEP, TTSUSTEP, TR5UGTEP, TIMUSTEP, 

*  TGPUSTEP, TAPUSTEP, TSPUSTEP, TKFUSTEP 
Integer  irst, jrst, krst 

*  DATA  INITIALIZATION 
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$  INCLUDE  {  '  ''/INCLUDE /SSDATA3  5  .DAT' ) 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA38  .DAT' ) 
$  INCLUDE  ( ' ''  /  INCLUDE  /SSDATA3  9  .  DAT  ' ) 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA42  .DAT ' ) 
$  INCLUDE  ( '  ''/INCLUDE/ SSDATA4  4  .DAT’ ) 
$  INCLUDE  ( ' ''/ INCLUDE /SSDATA4  5  .DAT' ) 
$  INCLUDE  ( ' ''  /  INCLUDE  /SSDATA4  6  .  D  AT ' ) 
$ INCLUDE ( ' "/ INCLUDE/ SSDATA4 7 .DAT' ) 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA48  .DAT ' ) 
$  INCLUDE  ( ' ''  /  INCLUDE  /  SSDATA4  9  .  DAT ' ) 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA50  .DAT  * ) 
$  INCLUDE  ( ' ''/ INCLUDE /SSDATAOl  .DAT' ) 
$  INCLUDE  ( '  ''/INCLUDE /SSDATAl  7  .DAT  ' ) 
$  INCLUDE  ( ' '' /INCLUDE/ SSDATAl  8  .DAT' ) 
$  INCLUDE  (  '  ''/INCLUDE/SSDATA21  .DAT' ) 
$  INCLUDE  { '  ''/INCLUDE/SSDATA22  .DAT' ) 
$  INCLUDE  { ' ''/ INCLUDE/ SSDATA2  3  .DAT* ) 
$  INCLUDE  (  ' ''/ INCLUDE /SSDATA2  8  .DAT' ) 
$  INCLUDE  (  ' ''  /  INCLUDE/  SSDATA2  9  .  DAT  ' ) 
$  INCLUDE  { '  “'  /  INCLUDE  /  SSDATA3  0  .  D  AT  ' ) 
$  INCLUDE  ( ' ''/ INCLUDE /SSDATA71  .DAT' ) 
$INCLUDE(  '''/INCLUD.  /SSTIMING  .DAT  ' ) 


$  INCLUDE  { ' ''  /  INCLUDE/SSMAS_cg .  DAT ' ) 

DATA  IMASS  ,  lAERO  ,  IBTHR  ,  IBAUTO  /  1,1,1,!/ 

*  INITIALIZE  80x87 
CALL  CW87 

$ INCLUDE ( ' SSp08.DAT ' ) 


C— . - . - . . . - . . 

c - main  execution  loop - 

c - - - - - - 

C  Execution  of  all  events  is  performed 

C  within  this  loop 

C 

C - - - - - 


1000  continue 


C  WRITE{*,*)' - BEGINNING  OF  LOOP - ' 

C - 

C - MISSILE  STATE  UPDATE  MODULE - 

C - 

C  Integrate  missile  states  to  current  time 

C 

C - 


IF  (  tstep  .gE.  tmsudriv  )  THEN 
tmsudriv  =  tmsudriv  +  tmsustep 


C -  VEHICLE  STATES  MODULE  - 

C - 

C  Compute  missile  state  derivatives 

C 

c - 
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CALL  MISSIL(T,CIM,MASS, 

FXACS, FXVCS, FYACS, FYVCS, 

FZACS,FZVC'?, 

X,  Y,  Z,  NCLEAR,  UD,  VD,  WD, 

GB, GR, MGR, FX, FY, FZ, XDD, YDD, ZDD, MXYZDD) 


MISSILE  STATE  INTEGRATION  MODULE 


Revise  missile  states  using  derivatives 
just  computed  .  Missile  states  must  not 
be  integrated  if  a  table  lookup  index 
transition  has  occurred  since  the  last 
integration  step  .  The  next  integration 
step  should  be  rescheduled  to  coincide 
with  the  earliest  detected  table  lookup 
index  transition  instead  .  Otherwise 
schedule  the  next  integration  step  to 
occur  at  the  default  step  size  . 


C  TRAPEZOIDAL  INTEGRATION  FOR  SIMPLICITY 

CALL  INTEG  (  XD  ,  XDD  ,  T  ,  6  ) 

CALL  INTEG  (  YD  ,  YDD  ,  T  ,  7  ) 

CALL  INTEG  (  ZD  ,  ZDD  ,  T  ,  8  ) 

CALL  INTEG  (X  ,  XD  ,  T  ,  9  ) 

CALL  INTEG  (  Y  ,  YD  ,  T  ,  10  ) 

CALL  INTEG  (  Z  ,  ZD  ,  T  ,  11  ) 

C  TRANSFORM  INERTIAL  POSITION  AND  VELOCITY  TO  EARTH  FRAME 

XYZE(l)  =  CIE(1)*X  +  CIE(4)*Y  -I-  CIE(7)*Z 
XYZE(2)  =CIE(2)*X  +CIE(5)*Y  +CIE(8)*Z 

XYZE(3)  =CIE{3)*X  +CIE(6)*Y  +CIE(9)*Z 

XYZEDd)  =CIE(1)*XD  +CIE(4)*YD  +CIE(7)*ZD 
XYZED(2)  =CIE(2)*XD  +CIE(5)*YD  +CIE(8)*ZD 
XYZED(3)  =CIE(3)*XD  +CIE(6)*YD  +CIE(9)*ZD 

XYZEDD (1)  =  CIE(1)*XDD  +  CIE(4)*YDD  +  CIE(7)*ZDD 
XYZEDD (2)  =  CIE(2)*XDD  +  CIE<5)*YDD  +  CIE(8)*ZDD 
XYZEDD (3)  =  CIE(3)*XDD  +  CIE(6)*YDD  +  CIE(9)*ZDD 

C  ROTATING  EARTH  MODEL 

CALL  MMK(0.0D0, 1 , 0 . ODO, 2, OMEGAE*T, 3, CER) 

XYZR(l)  =  CER(l) *XYZE (1)  +  CER(4) *XYZE (2)  +  CER(7) *XYZE (3) 

XYZR(2)  =  CER(2) *XYZE(1)  +  CER(5) *XYZE (2)  +  CER(8) *XYZE (3) 

XYZR(3)  =  CER(3) *XYZE(1)  +  CER ( 6) *XYZE (2 )  +  CER(9) *XYZE (3) 

CIR(l)  =  CER(l) *CIE(1)  +  CER(4)*CIE(2)  +  CER(7) *CIE (3) 

CIR(2)  =  CER(2) *CIE(1)  +  CER(5) *CIE (2)  +  CER (8) *CIE (3) 

CIR(3)  =  CER(3)*CIE(1)  +  CER(6) *CIE (2)  +  CER ( 9) *CIE (3) 

CIR(4)  =  CER(l) *CIE(4)  +  CER(4) *CIE (5)  +  CER (7) *CIE (6) 

CIR(5)  =  CER(2)*CIE(4)  +  CER(5) *CIE (5)  +  CER(8) *CIE (6) 

CIR{6)  =  CER(3) *CIE(4)  +  CER(6) *CIE (5)  +  CER ( 9) *CIE ( 6) 

CIR(7)  =  CER(l) *CIE(7)  +  CER(4) *CIE (8)  +  CER (7 ) *CIE ( 9) 

CIR(8)  =  CER(2) *CIE(7)  +  CER(5) *CIE (8)  +  CER (8) *CIE ( ») 

CIR(9)  =  CER{3) *CIE(7)  +  CER(6) *CIE (8)  +  CER(9) *CIE (9) 
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CRKl)  =  CIR{1) 

CRI(2)  =  CIR{4) 

CRI(3)  =  CIR(7) 

CRI{4)  =  CIR(2) 

CRI(5)  =  CIR(5) 

CRI(6)  =  CIR(8) 

CRI{7)  =  CIR(3) 

CRI(8)  =  CIR(6) 

CRI(9)  =  GIRO) 

C  CALCULATE  CURRENT  LATITUDE  AND  LONGITUDE 

LAT  =  DATAN2 (XYZR(3) ,DSQRT{XYZR(1) **2+XYZR(2) **2) ) /DTR 

LONG  =  DATAN2 (XYZR(2) ,XYZR(1) ) /DTR 

C  CALCULATE  CURRENT  MISSILE  ALTITUDE 

ALT  =  DSQRT  (  X**2  +  Y**2  +  Z**2  >  -  RADE 

C  SAVE  TIME  OF  LAST  MISSILE  STATE  UPDATE 

TLMSU  =  T 

END  IF 


Processor  communication 


C -  Communicate  with  pOl  - C 

CALL  SEND_REAL_32BIT (  SNGL(GR(01))  ) 

CALL  SEND_REAL_32BIT (  SNGL(GR(02))  ) 

CALL  SEND_REAL_32BIT (  SNGL(GR(03))  ) 

CALL  RECEIVE_REAL_32BIT(  S_MASS  ) 

MASS  =  S_MASS 

CALL  SEND_REAL_64BIT(  XYZE(Ol)  ) 

CALL  SEND_REAL_64BIT(  XYZE(02)  ) 

CALL  SEND_REAL_64BIT(  XYZE(03)  ) 

CALL  SEND_REAL_64BIT(  XYZED(Ol)  ) 

CALL  SEND_REAL_64BIT(  XYZED(02)  ) 

CALL  SEND_REAL_64BIT (  XYZpD(03)  ) 

C -  Communicate  with  p03 - C 

CALL  SEND_REAL_64BIT {  X  ) 

CALL  SEND_REAL_64BIT{  Y  ) 

CALL  SEND_REAL_64BIT{  Z  ) 

CALL  SEND_REAL_32BIT(  SNGL{X)  ) 

CALL  SEND_REAL_32BIT (  SNGL(Y)  ) 

CALL  SEND_REAL_32BIT (  SNGL(Z)  ) 

CALL  SEND_REAL_32BIT(  SNGL(XD)  ) 

CALL  SEND_REAL_32BIT (  SNGL{YD)  ) 

CALL  SEND_REAL_32BIT(  SNGL(ZD)  ) 

CALL  RECEIVE_REAL_32BIT{  S_CIM(1)  ) 

CALL  RECEIVE_REAL_32BIT(  S_CIM(2)  ) 

CALL  RECEIVE_REAL_32BIT(  S_CIM(3)  ) 

CALL  RECEIVE_REAL_32BIT(  S_CIM(4)  ) 

CALL  RECEIVE_REAL_32BIT (  S_CIM{5)  ) 

CALL  RECEIVE_REAL_32BIT(  S_CIM(6)  ) 

CALL  RECEIVE_REAL_32BIT (  S_CIM(7)  ) 

CALL  RECEIVE  REAL  32BIT(  S  CIM(8)  ) 
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CALL  RECEIVE_REAL_32BIT(  S_CIM{9)  ) 

CIM{1)  =  S_CIM(1) 

CIM(2)  =  S_CIM(2) 

CIM(3)  =  S_CIM(3) 

CIM{4)  =  S_CIM(4) 

CIM(5)  =  S_CIM(5) 

CIM(6)  =  S_CIM{6) 

CIM(7)  =  S_CIM(7) 

CIM{8)  =  S_CIM(8) 

CIM(9)  =  S_CIM(9) 

C -  Receive  from  ACSTHR  and  VCSTHR  - C 


CALL  receive_REAL_32BIT( 
CALL  receive_REAL_32BIT{ 
CALL  receive_REAL_32BIT( 
CALL  receive_REAL_32BIT ( 
CALL  receive_REAL_32BIT( 
CALL  receive_REAL_32BIT( 
FXVCS  =  S_FXVCS 
FYVCS  =  S_FYVCS 
FZVCS  =  S_FZVCS 
FXACS  =  S_FXACS 
FYACS  =  S_FYACS 
FZACS  =  S  FZACS 


S_fxvcs  ) 
S_fyvcs  ) 
S_fzvcs  ) 
S_fxacs  ) 
S_fyacs  ) 
S  fzaco  ) 


CALL  SEND_REAL_32BIT (  SNGL(UD)  ) 
CALL  SEND_REAL_32BIT {  SNGL(VD)  ) 
CALL  SEND  REAL  32BIT(  SNGL(WD)  ) 


OUTPUT  MODULE 


Creates  print  and  plot  output  data 
files 


iprint  =  iprint  +  1 

if  (  iprint  .eq.  int(dtprt)  )  then 
WRITE (MESSAGE, 202)  T,ALT,X,Y, Z 
CALL  OUTMES (MESSAGE) 

202  FORMATdX,  f8.4,  4E14.7) 
iprint  =  0 
END  IF 


TERMINATION  LOGIC 


Defines  the  simulation  termination 
conditions 


INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 
lEXIT  =  0 

ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED 

IF  (  T.GE.TFINAL  )  THEN 
lEXIT  =  1 
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END  IF 

ENABLE  EXIT  IF  MISSILE  HAS  IMPACTED  AND  ALL  EVENTS  SCHEDULED  FOR 
THIS  TIME  HAVE  BEEN  EXECUTED 

IF  (  ALT. LT. 0.0  )  THEN 
lEXIT  =  1 
END  IF 

C  increment  time 

TSTEP  =  TSTEP  +  l.ODO 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 


CALL  OUTMES( 'ERROR:  Exit  from  P08') 
END 
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B.1.10  Uup09.for 


C  PROGRAM  EXOSIM 

C - 

C - Declare  and  initialize  variables 

C - 


•C 

•C 

■C 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

CHARACTER* 12 8  MESSAGE 

COMMON  /  NORCOM  /  GSET  ,  I SET 

COMMON  /  RANCOM  /  RANSEQ(97),  RANLST 


REAL  MAGRTR 

,  snr 

REAL  LAMSEK(2) 

,  LAMM (2) 

real  gset,  ranlst 

INTEGER 

FRMCNT 

,  iset 

INTEGER 

SEKTYP 

,  ACQD 

INTEGER 

TERM 

,  TRACK 

INTEGER* 4 

SKSEED 

REAL  TSTEP,DELT 

REAL  TSPUDRIV,TSPUSTEP 

real  delt  time 

$INCLUDE ( > :pfp : INCLUDE/target . f or ' ) 

*  INITIALIZE  80x87 
CALL  CW87 


$ INCLUDE ( ' ssp09.dat ' ) 


C - 

c - main  execution  loop - 

C - 

C  Execution  of  all  events  is  performed 

C  within  this  loop 

C 

C - 

C  CALL  INITIALIZE_TIMING() 

1000  CONTINUE 

c  call  reset_timer () 

c  timer  =  read_timer() 

C  CALL  START_TIMING(0) 

C  WRITE(*,*)' - BEGINNING  OF  LOOP - ' 

C - 

C - Processor  communication - 

C - 


c 

c 

c 

c 

c 

c 

■c 


■c 

■c 

■c 


C  CALL  SWITCH_TIMING() 

C -  COMMUNICATION  WITH  KALMAN  - C 


call  send  real  32bit  (  lammd)  ) 
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call  send_real_32bit (  lairan(2)  ) 
call  send_real_32bit {  snr  ) 
call  send_real_32bit (  f rmrat  ) 

C -  COMMUNICATION  WITH  RELAT  - C 

CALL  RECEIVE_REAL_32BIT<  LAMSEK(Ol)  ) 

CALL  RECEIVE_REAL_32BIT (  LAMSEK(02)  ) 

CALL  RECEIVE  REAL  32BIT (  MAGRTR  ) 


C  CALL  SWITCH_TIMING() 

C - C 

C -  SEEKER  MODULE  - C 

C - C 

C  Calculates  LOS  angles  measured  by  the  C 

C  seeker  C 

C  C 

C - C 

IF  (  TSTEP  ,GE.  TSPUDRIV  )  THEN 

c  TSPUDRIV  =  TSPUDRIV  +  TSPUSTEP 


CALL  SEEKER (T, ACQD, LAMSEK, MAGRTR, SKSEED, FRMRAT, FRMCNT, 
SAMRAT, TRACK, TERM, SNR, LAMM) 

tspudriv  =  tspudriv  +  int (1000.0/ f rmrat) 

ENDIF 


c  delt_time  =  (timer  - (read_timer ()  +  18))/1.229e6 
c  CALL  output_message (  %VAL (real_32bit) ,  delt_time, 
c  &  %VAL(int2  (1) )  ) 
c  call  output_nl 

C - C 

C - OUTPUT  MODULE - C 

c - c 

c  call  stop_timing() 

c  if  (  mod(idnint (tstep) , idnint (dtprt) ) .eq. 0  )  then 

c  call  output_timing() 

C  call  INITIALIZE_TIMING() 

c  ENDIF 


C - C 

C - TERMINATION  LOGIC - C 

C - C 

C  Defines  the  simulation  termination  C 

C  conditions  C 

C  C 

C - c 

C  INITIALIZE  SIMULATION  UXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 

lEXIT  =  0 

C  increment  time 
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TSTEP  =  TSTEP  +  1.0 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
END 
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UuplO.for 

C  PROGRAM  EXOSIM 

C - 

C -  Declare  and  initialize  variables 

C - 


IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (0-Z) 

CHARACTER* 12 8  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 


COMMON 

/ 

NORCOM 

/ 

GSET 

t 

ISET 

COMMON 

/ 

RANCOM 

/ 

RANSEQ 

9 

RANLST 

COMMON 

/ 

RACCEL 

/ 

DRSIGA 

9 

PSIA  , 

THTA  , 

PHIA  , 

THXZA 

THXYA 

9 

THYZA  , 

THYXA  , 

THZYA  , 

THZXA 

SFIA 

9 

SF2A  , 

DCA  , 

TOACCE  , 

GRLST 

• 

XYZDP 

9 

ABI2  , 

ABIl  , 

AB02  , 

ABOl 

REAL  S_ 

_PD,S_QD,S 

RD, S_UD, 

S_ 

_VD,  S_WD, 

S_CIM(9) 

REAL  S_CG ( 3 ) , S_P , S_Q, S_R/ S_XD, S_YD, S_ZD , S_GR ( 3 ) 
DOUBLE  PRECISION  SF1A(3) 

REAL  RANSEQ{97) 

DOUBLE  PRECISION  GRLST{3) 

DOUBLE  PRECISION  ABI2{3) 

DOUBLE  PRECISION  AB01(3) 

DOUBLE  PRECISION  GR(3) 

DOUBLE  PRECISION  QFRACA(3)  , 

DOUBLE  PRECISION  LONGLP,  LATLP, 


SF2A(3)‘ 
RANLST 
XYZDP  (3) 
ABIl (3) 
CIM(9) 
PULSEA(3) 
CG(3) 
CIMO(9) 


DCA(3) 


AB02 (3) 


INTEGER* 4  GYSEED 
INTEGER  SEKTYP 


DOUBLE  PRECISION  TSTEP,DELT 
DOUBLE  PRECISION  TIMUDRIV, TIMUSTEP 


*  DATA  INITIALIZATION 

Sinclude  ( '  ''/include/ssdata35  .dat ' ) 
Sinclude  ( '  ''/include/ssdata38  .dat ' ) 
Sinclude  { ' "/include/ssdata39 .dat ' ) 
Sinclude  ( '  ''/include/ssdata42  .dat ' ) 
Sinclude  { '  ''/include/ssdata44  .dat ' ) 
Sinclude  { '  ''/include/ssdata45  .dat ' ) 
Sinclude  ( '  ''/include/ssdata46  .dat ' ) 
Sinclude  ( '  ''/include/ssdata47  .dat ' ) 
Sinclude  ( '  ''/include/ssdata48  .dat ' ) 
Sinclude  ( '  ''/include/ssdata49  .dat ' ) 
Sinclude  ( '  ''/include/ssdataSO  .dat ' ) 
Sinclude  ( '  ''/include/ssdataOl  .dat ' ) 
Sinclude  ( ' "/include/ssdatal7 .dat ' ) 
Sinclude  ( '  ''/include/ssdatal8  .dat ' ) 
Sinclude  ( '  ''/include/ssdata21  .dat ' ) 
Sinclude  ( '  ''/include/ssdata22  .dat ' ) 
Sinclude  ( ' ^/include/ssdata23 .dat ' ) 
Sinclude  ( '  ''/include/ssdata28  .dat ' ) 
Sinclude  ( '  ''/include/ssdata29  .dat ' ) 
Sinclude  (  "'/include/ssdataSO .dat ' ) 
Sinclude  ( ' ^/include/ssdata71 .dat ' ) 
Sinclude  ( '  ''/include/sstiming  .dat ' ) 
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call  cw87 

$inclucie  ( 'ssplO  .dat ' ) 


MAIN  EXECUTION  LOOP 


Execution  of  all  events  is  performed 
within  this  loop 


1000  CONTINUE 


WRITE(*,'')' - BEGINNING  OF  LOOP 


Processor  communication 


-  Communicate  with  pOl 

CALL  RECEIVE  REAL_32BIT (  S_GR(1)  ) 
CALL  RECEIVE"REAL_32BIT {  S_GR(2)  ) 
CALL  RECEIVE  REAL_32BIT(  S_GR(3)  ) 
3R(1)  =  DBLE"(S  GR(1)) 

GR(2)  =  DBLE  (S'“GR(2)  ) 

GR(3)  =  DOLE (S  GR(3) ) 


CALL  SEND_REAL  32BIT (  SNGL(PULSBA(01) )  ) 
CALL  SEND_REAL"32BIT (  SNGL (PULSEA(02) )  ) 
CALL  SEND_REAL_32BIT  (  SNGL  {PULSEA  ,(03) )  ) 

CALL  RECEIVE_REAL_32BIT (  S_CG(1)  ) 

CALL  RECEIVE_REAL_32BIT (  S_CG(2)  ) 

CALL  RECEIVE_REAL_32BIT {  S_CG(3)  ) 

CG(1)  =  DBLE(S_CG(1) ) 

CG(2)  =  DBLE(S_CG(2) ) 

CG(3)  =  DBLE(S_CG(3) ) 

CALL  RECEIVE_REAL_32BIT {  S_P  ) 

CALL  RECEIVE_REAL_32BIT (  S_Q  ) 

CALL  RECEIVE_REAL_32BIT (  S_R  ) 

P  =  DBLE(S_P) 

Q  =  DBLE(S_Q) 

R  =  DBLE{S_R) 

CALL  RECEIVE_REAL_32BIT (  S_XD  ) 

CALL  RECEIVE_REAL_32BIT (  S_YD  ) 

CALL  RECEIVE_REAL_32BIT (  S_ZD  ) 

XD  =  DBLE(S_XD) 

YD  =  DBLE(S_YD) 

ZD  =  DBLE(S_ZD) 

CALL  RECEIVE_REAL_32BIT(  S_CIM(1)  ) 

CALL  RECEIVE_REAL_32BIT {  S_CIM(2)  ) 

CALL  RECEIVE_REAL_32BIT(  S_CIM(3)  ) 

CAT.T.  RECRTVR_RF.AL_32BIT(  S_CIM(4)  ) 

CALL  RECEIVE_REAL_32BIT (  S_CIM(5)  ) 

CALL  RECEIVE_REAL_32BIT (  S_CIM(6)  ) 

CALL  RECEIVE_REAL_32BIT(  S_CIM(7)  ) 

CALL  RECEIVE_REAL_32BIT (  S_CIM(8)  ) 

CALL  RECEIVE  REAL_32BIT(  S_CIM(9)  ) 
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CIM{1)  =  DBLE{S_CIM(1) ) 

CIM(2)  =  DBLE(S_CIM(2) ) 

CIM(3)  =  DBLE(S  CIM(3) ) 

CIM(4)  =  DBLE(S~CIM(4) ) 

CIM(5)  =  DBLE(S~CIM(5) ) 

CIM(6)  =  DBLE(S_CIM(6) ) 

CIM(7)  =  DBLE(S  CIM{7) ) 

CIM(8)  =  DBLE(S~CIM{8) ) 

CIM(9)  =  DBLE(S__CIM(9)  ) 

CALL  RECEIVE_REAL_32BIT(  S_PD  ) 
CALL  RECEIVE_REAL_32BIT(  S_QD  ) 
CALL  RECEIVE_REAL_32BIT(  S_RD  ) 
CALL  RECEIVE_REAL_32BIT(  S_UD  ) 
CALL  RECEIVE_REAL_32BIT(  S_VD  ) 
CALL  RECEIVE  REAL  32BIT (  S  WD  ) 


PD  =  DBLE(S_PD) 

QD  =  DBLE(S_QD) 

RD  =  DBLE(S_RD) 

UD  =  DBLE(S_UD) 

VD  =  DBLE(S_VD) 

WD  =  DBLE(S_WD) 

C - 

C - INERTIAL  MEASUREMENT  UPDATE - 

C - 

C  Get  inertial  measurement  data  needed 

C  for  guidance  calculations  . 

C 

C . . . . . . 


IF  (  TSTEP  .GE.  TIMUDRIV  )  THEN 
TIMUDRIV  =  TIMUDRIV  +  TIMUSTEP 

C - 

C -  ACCELEROMETER  MODULE  - 

C - 

C  Determine  sensed  accelerations 

C 

C - - - 


CALL  ACCEL(T,UD, VD,WD,P,Q,R,PD,QD,RD,CG,CIM, XD, YD, ZD, 
GR, GYSEED, QFRACA, PULSEA) 

ENDIF 


C - 

C -  TERMINATION  LOGIC  - 

C - 

C  Defines  the  simulation  termination 

C  conditions 

C 

C - - - 

C  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 

lEXIT  =  0 

C  increment  time 
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TSTEP  =  TSTEP  +  1 . OdO 
T  =  TSTEP  *  CELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MOPE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
END 
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B.1.12  Uupll.for 

PROGRAM  EXOSIM 


Declare  and  initialize  vrariables 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

real  rdum 

CHARACTER* 12 8  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 


COMMON 

/ 

RMGUID 

/ 

ISEQ 

/ 

TVeOMP 

t 

OMEGAO 

t 

IMIDB2 

t 

TMIDB2 

t 

ISK30N 

COMMON 

/ 

RMAUTO 

/ 

ANGACL 

/ 

IMCPAS 

t 

TP 2 END 

t 

TP3END 

t 

IP2END 

t 

, 

TCOAST 

r 

ICOAST 

t 

TRDONE 

t 

IRATE 

i 

lACSBl 

t 

IACSB2 

t 

ICNT 

t 

IVPFL 

r 

IVPFLN 

t 

TBURN2 

t 

OMEGA I 

t 

TLSTMA 

t 

AACCEL 

COMMON 

/ 

RKVAUT 

/ 

SW17 

/ 

SW18 

t 

SW18P 

/ 

SW18Y 

t 

SW19 

! 

SW19P 

t 

SW19Y 

/ 

IROLL 

/ 

TPTON2 

f 

TYTON2 

/ 

• 

TNEXTP 

/ 

TNEXTY 

/ 

FLTCPL 

/ 

FLTCYL 

REAL  T,TSTEP,DELT 

REAL  TMSUDRIV, TIMUDRIV, TGPUDRIV, TAPUDRIV, TSPUDRIV, TKFUDRIV 
REAL  TMSUSTEP, TIMUSTEP, TGPUSTEP, TAPUSTEP, TSPUSTEP, TKFUSTEP 
REAL  FLTC(4) 

REAL  dtacsa_s (4) ,dtacsb_s (4) ,dtoffv  s (4) , tofflt_s (4) 

REAL  ANGACLO,  4, 10) 

REAL  OMEGAIO)  ,  GRLAST(3) 

REAL  OMEGAOO)  ,  AACCEL(3,4) 

INTEGER  FIRSTl  ,  FIRST2 

INTEGER  ISEQ(4)  ,  IMCPAS(3,4)  ,  FLIP 

C  OUTPUTS 


REAL 

MAGRTR 

/ 

MAGR 

r 

MASS 

REAL 

MAGV 

t 

MGRDOT 

t 

CMS (9) 

REAL 

ADISTT(4, 3) 

t 

LAMDXX(2) 

REAL 

LAMSEK(2) 

r 

LAMM (2) 

REAL 

RREL(3) 

r 

URREL(3) 

REAL 

VREL(3) 

r 

TI2M(9) 

REAL 

QS1(4) 

r 

VMI (3) 

r 

RMI (3) 

REAL 

VTEST{3) , 

VMIR(3),  GRTEST(3) 

REAL 

AT  (3) 

REAL 

CIE(9) 

NAMELIST  INPUTS 

REAL 

IXX 

r 

lYY 

t 

IZZ 

REAL 

CG(3) 

t 

DTOFFV(4) 

t 

VG(3) 

REAL 

DTACSA(4) 

t 

DTACSB(4) 

REAL 

XYZE  (3) 

t 

XYZED (3) 

REAL 

GRT(5, 3) 

t 

VTIC(5,3) 

t 

rtic (5, 3) 

REAL 

PULSEA{3) 

t 

PULGEG{3) 

REAL 

LAM (2) 

/ 

LAMD(2) 

t 

VGM(3) 

REAL 

DTVeSP (3) 

/ 

DTVCSy(3) 

REAL 

TOFFLT(4) 

t 

LATLP 

r 

LONGLP 

INTEGER 


SEKTYP 


ACQD 
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INTEGER 

INTEGER 

TERM 

TRACK 

,  TOSEED 

, ESTATE 

REAL  RTEST(3) 

,  RMIR(3) 

*  DATA  INITIALIZATION 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA3  5  .DAT' ) 

$ INCLUDE ( ' ^ / INCLUDE /SSDATA3 8 .DAT' ) 

$  INCLUDE  ( ' INCLUDE/ SSDATA3  9 .  DAT ' ) 

$INCLUDE ( ' ^/INCLUDE/SSDATA42 .DAT' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA44  .DAT  ' ) 

$  INCLUDE  ( ' ''  /  INCLUDE  /  S  SDATA4  5  .  DAT ' ) 

$  INCLUDE  ( '  -'/ INCLUDE  /  S  SDATA4  6.  DAT ' ) 

$INCLUDE  ( '  ''/INCLUDE/SSDATA47  .DAT' ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA4  8  .DAT  • ) 

$INCLUDE(  ■''/INCLUDE /S  SDATA49.DAT  ' ) 

$INCLUDE  ( » ''/INCLUDE/SSDATA50  .DAT' ) 

$ INCLUDE ( ' ^ / INCLUDE /SSDATAOl .DAT • ) 

$  INCLUDE  ( ' ''/ INCLUDE/ SSDATAl  7  .DAT  * ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATAl  8  .DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA21  .DAT  ' ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDATA2  2  .DAT ' ) 

$INCLUDE  ( '  ''/INCLUDE/SSDATA23  .DAT  * ) 

$  INCLUDE  ( ■''/ INCLUDE/ SSDATA2  8  .DAT ' ) 

SINCLUDE  ( '''/INCLUDE/SSDATA29.DAT' ) 

$  INCLUDE  ( ' ''/ INCLUDE/ SSDATA30  .DAT  ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDA1A71  .DAT  ' ) 

$INCLUDE  ( '  ''/INCLUDE/SSTIMING  .DAT ' ) 

SINCLUDE ( ' :pfp : INCLUDE/target . for ' ) 

*  INITIALIZE  80x87 

CALL  CW87 

$ INCLUDE (' SSpll.DAT') 

CALL  MCAUTO (T, IXX, lYY, IZZ,  SP,  SQ, SR, ROLLER, PITER, 

YAWER, IDIS,  IACSON,IBURND, IBURNM, IDMEAS, IPASSM, 
ICMD, 1 RATON, TPATON, TYATON, DTSAMP, TSAL, TSAH, 
TLAPS, ITHRES,ANVP,ACSLEV,TMAUTO, 0) 


idrop_s 

acslev_s 

dtacsa_s 

dtacsa_s 

dtacsa_s 

dtacsa_s 

dtacsb_s 

dtacsb_s 

dtacsb_s 

dtacsb_s 

dtoffv_s 

dtof fv_s 

dtoffv_s 

dtof fv_s 

ithres_s 

ivcs_s  = 

ivtab_s 

tatab_s 

tburnm_s 

timonv  s 


=  idrop 
=  acslev 

(1)  =  dtacsa  (1) 

(2)  =  dtacsa (2) 
(?)  =  dtacsa (3) 
^4)  =  dtacsa  (4) 

(1)  =  dtacsb(l) 

(2)  =  dtacsb(2) 

(3)  =  dtacsb(3) 
U)  =  dtacsb(4) 

(1)  =  dtoffv(l) 

(2)  =  dtoffv(2) 

(3)  =  dtoffv(3) 

(4)  =  dtoffv(4) 
=  ithres 

ivcs 
=  ivtab 
=  tatab 
=  t  bur  run 
=  timonv 


tofflt_s(l)  =  tofflt(l) 
tofflt_s(2)  -  tofflt(2) 
tofflt_s(3)  =  toffltO) 
tofflt_s(4)  =  tofflt(4) 
tvtab  s  =  tvtab 
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MAIN  EX::CUTION  LOOP 


Execution  o.'  all  events  is  performed 
within  this  loop 


1000  CONTINUE 

WRITE  (*,*)' - BEGINNING  OF  LOOP 


Processor  communication 


C - COMMUNICATION  WITH  POO - C 

CALL  RECEIVE_REAL_32BIT(  IXX  ) 

CALL  RECEIVE_REAL_32BIT (  lYY  ) 

CALL  RECEIVE_REAL_32BIT{  IZZ  ) 

'■  LL  RECEIVE_REAL_32BIT(  MASS  ) 

C - COMMUNICATION  WITH  POO - C 


CALL  SEND 


CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 


SEND 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 

send" 


COMMUNICATION  WITH 
REAL  32EIT(  ACSLEV_s  ) 


"REAL_32BIT(  DTACSA_S(01) 
"REAL_32BIT(  DTACSA_S(02) 
■rEAL_32BIT(  DTACSA_s(03) 
REAL_32BIT(  DTACSA_S(04) 
REAL_32BIT (  DTACSB_S (01) 
REAL  32BIT(  DTACSB_S{02) 
REAL“32BIT{  DTACSB_s(03) 
REAL_32BIT (  DTACSB_s (04) 
REAL_32BIT (  DTOFFV_s (01) 
REAL_32BIT  (  D'r''PFV_s  ( 02 ) 
REAL_32BIT(  D  ^FV_s(03) 
REAL_32BIT (  DTuFFV_s (04) 
SIGNED_16BIT(  ITHRES_S  ) 
SIGNED_16BIT(  IVCS_S  ) 
SIGNED_16BIT (  IVTAB_s  ) 
"REAL_32BIT(  TATAB_S  ) 
■rEAL_32BIT(  TBURNM_s  ) 
■rEAL_32BIT(  TIMONV_s  ) 
"REAL_32BIT(  TOFFLT_s(01) 
■rEAL_32BIT  (  T0FFLT_£:  ( 02 ) 
"REAL_32BIT(  TOFFLT_r,  (03) 
"REAL_32BIT(  TOFFLT_s(04) 
"real  32BIT(  TVTAB  s  ) 


C 


C 


COMMUNICATION  WITH  P02 


■C 


CALL  RECEI7E_SIGNED_16BIT(  IACSON  ) 

C -  COMMUNICATE  WITH  CORVEL  - C 


CALL  RECEIVE_REAL_32BIT(  VG(01)  ) 

CALL  RECEIVE_REAL_32BIT(  VG(02)  ) 

C-'.LL  RECEIVE_REAL_32BIT(  VG(03)  ) 

C - DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG - C 
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CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECE I VE_REA  L_3  2  B I T ( 
CALL  RECEIVE_REAL_32BIT( 
CALI.  RECEIVE  REAL  32BIT  ( 


TI2M(1) 

TI2M(2) 

TI2M(3; 

TI2M(4) 

TI2M(5) 

TI2M(6) 

TI2M(7) 

TI2M{8) 

TI2M(9) 


) 

) 

\ 

/ 

) 

) 

) 

) 

) 

) 


CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE  REAL  32BIT ( 


VREL(l) 

VREL(2) 

VREL(3) 

RREL(l) 

RREL(2) 

RREL(3) 


) 

) 

) 

) 

) 

) 


CALL  RECEIVE_REAL_32BIT (  SP  ) 
CALL  RECEIVE_REAL_32BIT (  SQ  ) 
CALL  RECEIVE  REAL  32BIT {  SR  ) 


call  send_real_32bit (  magr  ) 
call  send._real_32bit  (  magv  ) 
call  send_real_32bit (  tgo  ) 
call  send_real_32bit (  piter  ) 
call  send_real_32bit (  roller  ) 
call  send_real_32bit (  yawer  ) 
call  send_signed_16bit (  iburnl  ) 
call  send_real_32bit (  lamd(l)  ) 
call  send_real_32bit (  lamd(2)  ) 
call  send_signed_16bit (  acqd  ) 


call  receive_signed_16bit {  estate  ) 
call  receive_real_32bit (  piter  ) 
call  receive_real_32bit (  roller  ) 
call  receive_real_32bit (  yawer  ) 
call  receive_signed_16bit (  iburnl  ) 
call  receive_real_32bit (  lamd(l)  ) 
call  receive_real_32bit (  lamd(2)  ) 
call  receive_signed_16bit (  acqd  ) 
call  receive_real_32bit (  tgel  ) 
call  receive_real_32bit (  tge2al  ) 
call  receive_real_32bit (  trmtgo  ) 


ON  BOARD  GUIDANCE  PROCESSING 


Determine  guidance  commands 


IF  (  TSTEP  .GE.  TGPUDRIV  )  THEN 

TGPUDRIV  =  TGPUDRIV  +  TGPUSTEP 


ESTIMATED  RELATIVE  STATES  MODULE 


Estimate  range,  range  rate,  and  time-to- 
go  based  on  navigation  output  and  target 
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model  estimates 


CALL  ESTREL (TI2M, CMS, ESTATE, RREL, VREL, 

MAGR, MAGV, URREL, MGRDOT, TGO, PITER, YAWER, LAMD) 

END  IF 


Processor  communication 


C - COMMUNICATION  WITH  POO - C 

CALL  RECEIVE_REAL_32BIT (  IXX  ) 

CALL  RECEIVE_REAL_32BIT(  lYY  ) 

CALL  RECEIVE_REAL_32BIT (  IZZ  ) 

CALL  RECEIVE_REAL_32BIT(  MASS  ) 

C - COMMUNICATION  WITH  POO - C 

CALL  SEND_SIGNED_16BIT<  IDROP_s  ) 

C - COMMUNICATION  WITH  pn->  C 

CALL  SEND_REAL_32BIT (  ACSLEV_s  ) 

CALL  SEND_REAL_32BIT (  DTACSA_S(01)  ) 

CALL  SEND_REAL_32BIT (  DTACSA_s(02)  ) 

CALL  SEND_REAL_32BIT (  DTACSA_S(03)  ) 

CALL  SEND_REAL_32BIT (  DTACSA_S(04)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_s(01)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_s(02)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_S(03)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_S(04)  ) 

CALL  SEND_REAL_32BIT(  DTOFFV_S(01)  ) 

CALL  SEND_REAL_32BIT (  DTOFFV_S(02)  ) 

CALL  SEND_REAL_32BIT (  DTOFFV_s(03)  > 

CALL  SEND_REAL_323IT (  DTOFFV_s{04)  ) 

CALL  SEND_SIGNED_16BIT(  ITHRES_S  ) 

CALL  SEND_SIGNED_16BIT(  IVCS_S  ) 

CALL  SEND_SIGNED_16BIT (  IVTAB_s  ) 

CALL  SEND_REAL_32BIT (  TATAB_s  ) 

CALL  SEND_REAL_32BIT (  TBURNM_s  ) 

CALL  SEND_REAL_32BIT (  TIMONV_s  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_S(01)  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_s(02)  ) 

CALL  SEND_REAL_32BIT(  TOFFLT_s(03)  ) 

CALL  SEND_REAL_32BIT {  TOFFLT_S(04)  ) 

CALL  SEND_REAL_32BIT (  TVTAB_S  ) 

C - COMMUNICATION  WITH  P02 - C 

CALL  RECEIVE_SIGNED_16BIT(  lACSON  ) 

C -  COMMUNICATE  WITH  CORVEL  - C 

CALL  RECEIVE_REAL_32BIT(  VG(Ol)  ) 

CAT.L  PECEIVE_REAL_32BIT  (  VG(02)  ) 

CALL  RECEIVE_REAL_32BIT(  VG(03)  ) 

C - DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG - C 

CALL  RECEIVE  REAL  32BIT (  TI2M(1)  ) 
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CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT { 
CALL  RECEIVE_REAL_32BIT( 
CALL  RECEIVE_REAL_32BIT{ 
CALL  RECEIVE_REAL_32BIT( 
CALL  RECEIVE  REAL  32BIT( 


TI2M(2)  ) 
TI2M{3)  ) 
TI2M(4)  ) 
TI2M(5)  ) 
TI2M(6)  ) 
TI2M(7)  ) 
TI2M(8)  ) 
TI2M(9)  ) 


CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT( 
CALL  RECEIVE_REAL_32BIT( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE_REAL_32BIT ( 
CALL  RECEIVE  REAL  32BIT( 


VREL(l)  ) 
VREL(2)  ) 
VREL(3)  ) 
RREL(l)  ) 
RREL(2)  ) 
RREL(3)  ) 


CALL  RECEIVE_REAL_32BIT(  SP  ) 
CALL  RECEIVE_REAL_32BIT(  SQ  ) 
CALL  RECEIVE  REAL  32BIT(  SR  ) 


MISSILE  STATE  UPDATE  MODULE  - 

Integrate  missile  states  to  current  time 


VeS  THRUSTER  RESPONSE  MODULE 


Determines  the  forces  and  moments 
imparted  by  the  VCS  thrusters 


IF  (  T.GE.TKVON  )  THEN 

CALL  VCSTHR2 (T, FLTC, FLTCP, FLTCY, TBURNM, TOFFLT, 
L.-.  onv,  IVTAB) 


ACS  THRUSTER  RESPONSE  MODULE 


Determines  the  forces  and  moments 
imparted  by  the  ACS  thrusters 


CALL  ACSTHR2 (ITHRES) 
ENDIF 


SEPARATION  MODULE 


Models  discontinuities  occuring  during 
stage  separation 
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C - C 


C  NOSE  FAIRING  /  BOOST  ADAPTER  SEPARATION 

IF  (  IDROP.EQ.l  .OR.  (ABS (T-TDROP) . LE .DTEPS 
*  .AND.  IGIT.EQ.l  )  )  THEN 

IDROP  =  2 
IPASSM  =  0 
ENDIF 


IF  (  TSTEP  .GE.  TGPUDRIV  )  THEN 
TGPUDRIV  =  TGPUDRIV  +  TGPUSTEP 


MIDCOURSE  GUIDANCE  MODULE 


Calculates  roll  error,  controls 
midcourse  sequencing,  and  issues 
midcourse  diverts 


IF  (  T.GT.TSTG2  .AND. 

T.GE.TMGUID  .AJ^D.  ACQD.EQ.G  )  THEN 

CALL  MCGUID (T, TI2M, VG, URREL, MASS, IDIST, MIDBRN, MAGR, 

MAGV, SP, SQ, SR, PITER, YAWER, FLIP, IVCS, ICMD, IDMEAS, IDPASS, 
IDROP, IMCEND, IBURND, IBURNM, VGM,  ADI STT, ROLLER, 
TMGUID) 


ENDIF 

ENDIF 


KALMAN  FILTER  MODULE 


call  send_real_32bit (  magr  ) 
call  senc’_real_32bit  (  magv  ) 
call  send_real_32bit (  tgo  ) 
call  send_real_32bit (  piter  ) 
call  send_real_32bit (  roller  ) 
call  send_real_32bit (  yawer  ) 
call  send_signed_16bit (  iburnl  ) 
call  send_real_32bit (  lamd(l)  ) 
call  send_real_32bit (  lamd(2)  ) 
call  send_signed_16bit (  acqd  ) 

call  receive_signed_16bit (  estate  ) 
call  receive_real_32bit (  piter  ) 
call  receive_real_32bit (  roller  ) 
call  receive_real_32bit {  yawer  ) 
call  receive_signed_16bit {  iburnl  ) 
call  receive_real_32bit (  lamd(l)  ) 
call  receive  real  32bit (  lamd(2)  ) 
call  receive_signed_16bit (  acqd  ) 
call  receive_real_32bit (  tgel  ) 
call  receive_real_32bit (  tge2al  ) 
call  receive_real_32bit (  trmtgo  ) 


C 


C 
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Q -  Processor  communication  - C 


C - COMMUNICATION  WITH  POO - C 

CALL  RECEIVE_REAL_32BIT(  IXX  ) 

CALL  RECEIVE_REAL_32BIT(  lYY  ) 

CALL  RECEIVE_REAL_32BIT (  IZZ  ) 

CALL  RECEIVE_REAL_32BIT(  MASS  ) 

C - COMMUNICATION  WITH  POO - C 

CALL  SEND_SIGNED_16BIT (  IDROP_S  ) 

C - COMMUNICATION  WITH  P02  C 

CALL  SEND_REAL_32BIT {  ACSLEV_S  ) 

CALL  SEND_REAL_32BIT (  DTACSA_S(01)  ) 

CALL  SEND_REAL_32BIT (  DTACSA_S(02)  ) 

CALL  SEND_REAL_32BIT(  DTACSA_S(03)  ) 

CALL  SEND_REAL_32BIT(  DTACSA_S(04)  ) 

CALL  SEND_REAL_32BIT(  DTACSB_S(01)  ) 

CALL  SEND_REAL_?2BIT(  DTACSB_S(02)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_S(03)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_s(04)  ) 

CALL  SEND_REAL_32BIT (  DTOFFV_s(01)  ) 

CALL  SEND_REAL_32BIT (  DTOFFV_S{02)  ) 

CALL  SEND_REAL_32BIT(  DTOFFV_s(03)  ) 

CALL  SEND_REAL_32BIT(  DTOFFV_s(04)  ) 

CALL  SEND_SIGNED_16BIT(  ITHRES_S  ) 

CALL  SEND_SIGNED  16BIT(  IVCS_S  ) 

CALL  SEND_SIGNED~16BIT(  IVTAB_S  ) 

CALL  SEND_REAL_32BIT (  TATAB_S  ) 

CALL  SEND_REAL_32BIT(  TBURNM  S  ) 

CAIL  SEND_REAL_32BIT(  TIMONV“s  ) 

CALL  SEND_REAL_32BIT (  TOFFLT“s(01)  > 

CALL  SEND_REAL_32BIT (  TOFFLT_S(02)  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_S(03)  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_S(04)  ) 

CALL  SEND_REAL_32BIT(  TVTAB_s  ) 

C - COMMUNICATION  WITH  P02  C 

CALL  RECEIVE_SIGNED_16BIT (  lACSON  ) 

C -  COMMUNICATE  WITH  CORVEL  - C 

CALL  RECEIVE_REAL_32BIT{  VG(Ol)  ) 

CALL  RECEIVE_REAL_32BIT(  VG(02)  ) 

CALL  RECEIVE_REAL_32BIT (  VG(03)  ) 

C -  DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG  - C 

CALL  RECEIVE_REAL_32BIT (  TI2M(1)  ) 

CALL  RECEIVE_REAL_32BIT{  TI2M(2)  ) 

CALL  RECEIVE_REAL_32BIT (  TI2M(3)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(4)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(5)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(6)  ) 

CALL  RECEIVE_REAL_32BIT (  TI2M(7)  ) 

CALL  RECEIVE_REAL_3?BIT (  TI2M(8)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(9)  ) 

CALL  RECEIVE_REAL_32BIT(  VREL(l)  ) 

CALL  RECEIVE  REAL  32BIT (  VREL{2)  ) 


2ia 


oo  oooooo  ooooo 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


CALL  RECEIVE_REAL_32BIT(  VREL(3) 
CALL  RECEIVE_REAL_32BIT(  RREL(l) 
CALL  RECEIVE_REAL_32BIT(  RREL(2) 
CALL  RECEIVE_REAL  32 BIT (  RREL(3) 


) 

) 

) 

) 


CALL  RECEIVE_REAL  32BIT(  SP  ) 
CALL  RECEIVE_REAL“32BIT (  SQ  ) 
CALL  RECEIVE  REAL  32BIT (  SR  ) 


call  send_real_32bit (  magr  ) 
call  seiad_real_32bit  (  magv  ) 
call  send_real_32bit {  tgo  ) 
call  send_real_32bit (  piter  ) 
call  send_real_32bit (  roller  ) 
call  send_real_32bit (  yawer  ) 
call  send_signed_16bit (  iburnl  ) 
call  send_real_32bit (  lamd(l)  ) 
call  send_real_32bit (  lamd(2)  ) 
call  send_signed_16bit (  acqd  ) 


call  receive_signed_16bit (  estate  ) 
call  receive_real_32bit (  piter  ) 
call  receive_real_32bit (  roller  ) 
call  receive_real_32bit (  yawer  ) 
call  receive_signed_16bit (  iburnl  ) 
call  receive_real_32bit (  lamd(l)  ) 
call  receive_real_32bit  (  larpd(2)  ) 
call  receive_signed_16bit (  acqd  ) 
call  receive_real_32bit (  tgel  ) 
call  receive_real_32bit (  tge2al  ) 
call  receive_real_32bit {  trmtgo  ) 


AUTOPILOTS 


IF  (  TSTEP  .GE.  TAPUDRIV  )  THEN 


MIDCOURSE  AUTOPILOT  MODULE 


Performs  large  angle  reorients  and  rate 
control  during  midcourse 


IF  (  T.GE.TKVON  )  THEN 

IF  (  T.GT.TSTG2  .AND.  T.GE.TMAUTO  .AND. 

(  ICMD.NE.O  .OR.  ACQD.EQ.O)  )  THEN 

CALL  MCAUTO (T, IXX, lYY, IZZ, SP, SQ, SR, ROLLER, PITER, 

YAWER, IDIST, lACSON, IBURND, IBURNM, IDMEAS, IPASSM, 
ICMD, TRATON, TPATON, TYATON, DTSAMP, TSAL, TSAH, 
TLAPS, ITHRES,ANVP, ACSLEV,TMAUTO, 1) 


END  IF 
END  IF 
END  IF 
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C - c 

idrop_s  =  idrop 

C - COMMUNICATION  WITH  POO - C 

CALL  RECEIVE_REAL_32BIT (  IXX  ) 

CALL  RECEIVE_REAL_32BIT (  lYY  ) 

CALL  RECEIVE_REAL_32BIT(  IZZ  ) 

CALL  RECEIVE_REAL_32BIT(  MASS  ) 

C - COMMUNICATION  WITH  POO - C 

CALL  SEND_SIGNED_16BIT(  IDROP_S  ) 

C - COMMUNICATION  WITH  P02 - C 

CALL  SEND_REAL_32BIT <  ACSLEV_s  ) 

CALL  SEND_REAL_32BIT (  DTACSA_s(01)  ) 

CALL  SEND_REAL_32BIT (  DTACSA_s{02)  ) 

CALL  SEND_RSAL_32BIT (  DTACSA_S(03)  ) 

CALL  SEND_REAL_32BIT (  DTACSA_S{04)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_s(01)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_s(02)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_s{03)  ) 

CALL  SEND_REAL_32BIT(  DTACSB_s(04)  ) 

CALL  SEND_REAL_32BIT(  DTOFFV_s(01)  ) 

CALL  SEND_REAL_32BIT(  DTOFFV_s(02)  ) 

CALL  SEND_REAL_32BIT (  DTOFFV_s(03)  ) 

CALL  SEND_REAL_32PIT(  DTOFFV_S(04)  ) 

CALL  SEND_SIGNED_16BIT(  ITHRES_S  ) 

CALL  SEND_SIGNED_16BIT(  IVCS_S  ) 

CALL  SEND_SIGNED_16BIT(  IVTAB_S  ) 

CALL  SEND_REAL_32BIT {  TATAB  S  ) 

CALL  SEND_REAL_32BIT (  TBURNM_S  ) 

CALL  SEND_REAL_32BIT(  TIMONV_s  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_S(01)  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_S(02)  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_S(03)  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_s(04)  ) 

CALL  SEND_REAL_32BIT(  TVTAB_S  ) 

C - COMMUNICATION  WITH  P02 - C 

CALL  RECEIVE_SIGNED_16BIT(  lACSON  ) 

C -  COMMUNICATE  WITH  CORVEL  - C 

CALL  RECEIVE_REAL_32BIT<  VG(Ol)  ) 

CALL  RECEIVE_REAL_32BIT (  VG(02)  ) 

CALL  RECEIVE_REAL_32BIT(  VG(03)  ) 

C -  DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG  - C 

CALL  RECEIVE_REAL_32BIT(  TI2M(1)  ) 

CALL  RECEIVE_REAL_32BIT{  TI2M(2)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(3)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(4)  ) 

CALL  RECEIVE_REAL_32BIT (  TI2M(5)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(6)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(7)  ) 

CALL  RECEIVE_REAL_32DIT(  TI2M(8)  ) 

CALL  RECEIVE_REAL_32Bir(  TI2M(9)  ) 

CALL  RECEIVE_REAL_32BIT {  VREL(l)  ) 

CALL  RECEIVE_REAL_32BIT(  VREL(2)  ) 

CALL  RECEIVE  REAL  32BIT(  VREL{3)  ) 
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CALL  RECEIVE_REAL_32BIT(  RREL(l)  ) 
CALL  RECEIVE_REAL_32BIT(  RREL(2)  ) 
CALL  RECEIVE  REAL  32BIT(  RREL(3)  ) 


CALL  RECEIVE_REAL_32BIT (  SP  ) 
CALL  RECEIVE_REAL_32BIT(  SQ  ) 
CALL  RECEIVE  REAL  32BIT(  SR  ) 


call  sendl_real_32bit  (  magr  ) 
call  send_real_32bit (  magv  ) 
call  senci_real_32bit  (  tgo  ) 
call  send_real_32bit (  piter  ) 
call  send_real_32bit (  roller  ) 
call  send_real_32bit (  yawer  ) 
call  send_signed_16bit (  iburnl  ) 
call  send_real_32bit (  lamd(l)  ) 
call  send_real_32bit (  lamd(2)  ) 
call  send_signed_16bit (  acqd  ) 

call  receive_signed_16bit (  estate  ) 
call  receive_real_32bit (  piter  ) 
call  receive_real_32bit (  roller  ) 
call  receive_real_32bit (  yawer  ) 
call  receive_signed_16bit (  iburnl  ) 
call  receive_real_32bit (  lamd(l)  ) 
call  receive_real_32bit (  lamd(2)  ) 
call  receive_signed_16bit (  acqd  ) 
call  receive_real_32bit (  tgel  ) 
call  receive_real_32bit (  tge2al  ) 
call  receive_real_32bit (  trmtgo  ) 


AUTOPILOTS 


IF  (  TSTEP  .GE.  TAPUDRIV  )  THEN 
IF  (  T.GE.TKVON  )  THEN 


KV  AUTOPILOT  MODULE 


Calls  the  various  ACS  autopilot 
modes  used  for  controlling  the 
kill  vehicle  attitude  during  flight. 
Its  purpose  is  to  define  which 
thruster  to  burn,  for  how  long,  and  at 
what  thrust  level. 


C.^iLL  KVAUTO  (T,  SP,  SQ,  SR,  FLTCP,  FLTCY,  IXX,  lYY,  IZ2,  ADISTT, 

ROLLER, PITER, YAWER, TCWAIT, IDIST, SW80 , TSAL, TSAH, 
TNEXT, TLAPS, ANVP, DTSAMP, ACSLEV, TRATON, TPATON, 
TYATON,  TTHRF.S) 


END  IF 
END  IF 


C 


COMMUNICATION  WITH  POO 


■C 
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CALL  RECEIVE_REAL_32BIT(  IXX  ) 

CALL  RECEIVE_REAL_32BIT(  lYY  ) 

CALL  RECEIVE_REAL_32BIT (  IZZ  ) 

CALL  RECEIVE_REAL_32BIT (  MASS  ) 

C - COMMUNICATION  WITH  POO - C 

CALL  SEND_SIGNED_16BIT(  IDROP_S  ) 

C - COMMUNICATION  WITH  P02 - C 

CALL  SEND_REAL_32BIT (  ACSLEV_s  ) 

CALL  SEND_REAL_32BIT (  DTACSA_s(01)  ) 

CALL  SEND_REAL_32BIT <  DTACSA_s(02)  ) 

CALL  SEND_REAL_32BIT (  DTACSA_s(03)  ) 

CALL  SEND_REAL_32BIT (  DTACSA_S(04)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_s  (01)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_s(02)  ) 

CALL  SEND_REAL_32BIT(  DTACSB_S  (03)  ) 

CALL  SEND_REAL_32BIT (  DTACSB_S(04)  ) 

CALL  SEND_REAL_32’3IT(  DTOFFV_s(01)  ) 

CALL  SEND_REAL_32BIT(  DTOFFV_s(02)  ) 

CALL  SEND_REAL_32BIT(  DTOFFV_s(03)  ) 

CALL  SEND_REAL_32BIT(  DTOFFV_S(04)  ) 

CALL  SEND_SIGNED_16BIT(  ITHRES_S  ) 

CALL  SEND_SIGNED_16BIT(  IVCS_S  ) 

CALL  SEND_SIGNED_16BIT(  IVTAB_S  ) 

CALL  SEND_REAL_32BIT (  TATAB_S  ) 

CALL  SEND_REAL_32BIT(  TBURNM_S  ) 

CALL  SEND_REAL_32BIT(  TIMONV_s  ) 

CALL  SEND_REAL_32BIT(  TOFFLT_S(01)  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_S(02)  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_s(03)  ) 

CALL  SEND_REAL_32BIT (  TOFFLT_S(04)  ) 

CALL  SEND_REAL_32BIT (  TVTAB_s  ) 

C - COMMUNICATION  WITH  P02 - C 

CALL  RECEIVE_SIGNED_l6BIT(  lACSON  ) 

C -  COMMUNICATE  WITH  CORVEL  - C 

CALL  RECEIVE_REAL_32BIT (  VG(Ol)  ) 

CALL  RECEIVE_REAL_32BIT(  VG(02)  ) 

CALL  RECEIVE_REAL_32BIT(  VG(03)  ) 

C -  DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG  - C 

CALL  RECEIVE_REAL_32BIT (  TI2M(1)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(2)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(3)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(4)  ) 

CALL  RECEIVE_REAL_32BIT (  TI2M(5)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(6)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(7)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(8)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(9)  ) 

CALL  RECEIVE_REAL_32BIT(  VREL(l)  ) 

CALL  RECEIVE  REAL  32BIT (  VREL(2)  ) 

CALL  RECEIVE_REAL_32BIT (  VREL(3)  ) 

CALL  RECEIVE_REAL_32BIT(  RREL(l)  ) 

CALL  RECEIVE_REAL_32BIT (  RREL(2)  ) 

CALL  RECEIVE  REAL  32BIT (  RREL(3)  ) 


278 


noon  o  oooooooo  ooooo 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


CALL  RECEIVE_REAL_32BIT(  SP  ) 

CALL  RECEIVE_REAL__32BIT(  SQ  ) 

CALL  RECEIVE_REAL_32BIT(  SR  ) 

call  send._real_32bit  (  magr  ) 
call  send_real_32bit (  magv  ) 
call  send_real_32bit (  tgo  ) 
call  send_real_32bit (  piter  ) 
call  send_real_32bit {  roller  ) 
call  send_real_32bit (  yawer  ) 
call  send_signed_16bit (  iburnl  ) 
call  send_real_32bit (  larad(l)  ) 
call  send_real_32bit (  lamd(2)  ) 
call  send_signed_16bit (  acqd  ) 

call  receive_signed_16bit {  estate  ) 
call  receive_real_32bit (  piter  ) 
call  receive_real_32bit (  roller  ) 
call  receive_real_32bit (  yawer  ) 
call  receive_signed_16bit (  iburnl  ) 
call  receive_real_32bit (  lamd(l)  ) 
call  receive_real_32bit {  lamd(2)  ) 
call  receive_signed_16bit (  acqd  ) 
call  receive_real__32bit  (  tgel  ) 
call  receive_real"32bit (  tge2al  ) 
call  receive_real_32bit (  trmtgo  ) 


AUTOPILOTS 


IF  (  TSTEP  .GE,  TAPUDRIV  )  THEN 
TAPUDRIV  =  TAPUDRIV  +  TAPUSTEP 
IF  <  T.GE.TKVON  )  THEN 


ves  LOGIC  MODULE 


Controls  the  kill  vehicle  velocity  by 
determining  the  appropriate  VCS  thruster 
on  and  off  times. 


CALL  VeSLOGd,  MASS,  LAMD,  TGO,  MAGV,  TGIL,  TRMTGO,  TGE2AL, 

TGE1,VGM, IveS, IDMEAS, IBURNM, MIDBRN, IBURNl, IBURN2, 

IBURN3, IDIST, FLTC, FLTCP,  FLTCY, TSAL, TSAH, TOFFLT, 
TOFLTM,TBURNP, TBURNY,  TGE2,  TGIIP,  TGI2P,  TGI3P, 
TGIIY, TGI2Y, TGI3Y, TIMONV, TGOFLM,  TCWAIT, DTVCSP, 
DTVeSY, DTOFFV, TBURNM) 

SET  FLAG  TO  COMPUTE  VCS  THRUSTER  RESPONSE  TABLE 

IVTAB  =  1 
TVTAB  =  T 


ACS  RESOLVING  LOGIC  MODULE 
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C 


IF  (  ITHRES.EQ.l  )  THEN 

CALL  RESTHR(T, IDIST, ANVP, DTSAMP, TOFLTM, TRATON, 
TPATON, TYATON, DTACSA, DTACSB) 

BEGINNING  TIME  OF  ACS  THRUSTER  RESPONSE  TABLE 

TATAB  =  T 

END  IF 

END  IF 


ENDIF 

ithres_s  =  ithres 
acslev  s  =  acslev 


dtacsa_s 

dtacsa_s 

dtacsa_s 

dtacsa_s 

dtdC‘>b_s 

dtacsb_s 

dtacsb_s 

dcacsb_s 

dtof fv_s 

dtof fv_s 

dtoffv_s 

dtoffv_s 

ivcs_s  = 

ivtab_s 

tatab_s 

tburnm_s 

timonv_s 

tofflt_s 

tofflt_s 

tofflt_s 

toff lt_s 

tvtab  s 


(1)  =  dtaesa  (1) 

(2)  =  dtaesa (2) 

(3)  =  dtaesa (3) 

(4)  =  dtaesa (4) 

(1)  =  dtaesb(l) 

(2)  =  dtaesb(2) 

(3)  =  dtaesb(3) 

(4)  =  dtaesb(4) 

(1)  =  dtoffv(l) 

(2)  =  dtoffv(2) 

(3)  =  dtoffv(3) 

(4)  =  dtoffv(4) 
ives 

=  ivtab 
=  tatab 
=  tburnm 
=  timonv 

(1)  =  tofflt(l) 

(2)  =  tofflt{2) 

(3)  =  tofflt(3) 

(4)  =  tofflt  (4) 
=  tvtab 


TERMINATION  LOGIC 


Defines  the  simulation  termination 
eonditions 


INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 
lEXIT  =  0 

ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED 

IF  {  T.GE.TFINAL  )  THEN 
lEXIT  =  1 
ENDIF 

C  inerement  time 

TSTEP  =  TSTEP  +  5.0E0 
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T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
END 
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B.1.13  Uupl2.for 

PROGRAM  EXOSIM 


Declare  and  initialize  variables 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

real  rdum 

CHARACTER* 12 8  MESSAGE 

C  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RKALMN  /  TKF  ,  IDRTOK  ,  PPll  ,  PP12  ,  PP22  , 

PYll  ,  PY12  ■  ,  PY22  ,  PLMDFP  ,  YLMDFP  , 

PLAMH  ,  YLAMH  ,  PLAMDH  ,  YLAMDH  ,  PLAMDF  , 

YLAMDF  ,  TGIL  ,  KFMODE  ,  IFPAS 

REAL  T,TSTEP,DELT 

REAL  TMSUDRIV, TIMUDRIV, TGPUDRIV, TAPUDRIV, TSPUDRIV, TKFUDRIV 
REAL  TMSUSTEP, TIMUSTEP, TGPUSTEP, TAPUSTEP, TSPUSTEP,  TKFUSTEP 
REAL  FLTC(4) 

REAL  dtacsa_s (4) ,dtacsb_s (4) ,dtoffv_s (4) , tofflt_s (4) 

REAL  ANGACLO,  4, 10) 

REAL  OMEGAIO)  ,  GRLAST(3) 

REAL  OMEGAOO)  ,  AACCEL(3,4) 

INTEGER  FIRSTl  ,  FIRST2 

INTEGER  ISEQ(4)  ,  IMCPAS(3,4)  ,  FLIP 

C  OUTPUTS 

REAL  MAGRTR  ,  MAGR  ,  MASS 

REAL  MAGV  ,  MGRDOT  ,  CMS (9) 

REAL  ADISTT(4,3)  ,  LAMDXX(2) 

REAL  LAMSEK(2)  ,  LAMM (2) 

REAL  RREL(3)  ,  URREL(3) 

REAL  VREL(3)  ,  TI2M(9) 

REAL  QS1{4)  ,  VMI(3)  ,  RMI(3) 

REAL  VTEST(3),  VMIR(3),  GRTEST(3) 

REAL  AT (3) 

REAL  CIE(9) 

C  NAMELIST  INPUTS 

REAL  IXX  ,  lYY  ,  IZZ 

REAL  CG(3)  ,  DTOFFV(4)  ,  VG(3) 

REAL  DTACSA(4)  ,  DTACSB(4) 

REAL  XYZE{3)  ,  XYZED(3) 

REAL  GRT(5,3)  ,  VTIC(5,3)  ,  rtic(5,3) 

REAL  PULSEA(3)  ,  PULSEG(3) 

REAL  LAM(2)  ,  LAMD(2)  ,  VGM(3) 

REAL  DTVCSP(3)  ,  DTVCSY(3) 

REAL  TOFFLT(4)  ,  LATLP  ,  LONGLP 

INTEGER  SEKTYP  ,  ACQD 

INTEGER  TERM  ,  TOSEED  , ESTATE 

INTEGER  TRACK 

REAL  RTEST(3)  ,  RMIR{3) 
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*  DATA  INITIALIZATION 

$  INCLUDE  ( '  /  INCLUDE /SSDATA3  5  .DAT  ' ) 
$INCLUDE ( ' ^/INCLUDE/SSDATA38 .DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA39.DAT' ) 

$  INCLUDE  (  '  ''/INCLUDE/ SSDATA4  2  .DAT' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA44  .DAT' ) 

$  INCLUDE ( ' ^/INCLUDE/SSDATA45 .DAT ' ) 
$INCLUDE  ( '  ''/INCLUDE/SSDATA46  .DAT  ' ) 

$  INCLUDE  { '  ''/INCLUDE/SSDATA47  .DAT  ' ) 

$  INCLUDE  (  '  ''/INCLUDE/SSDATA48  .DAT  ' ) 

$  INCLUDE  (  '  ''/INCLUDE/SSDATA4  9.DAT  '  ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA50  .DAT  '  ) 

$  INCLUDE  ( '  -'/INCLUDE/SSDATAOl  .DAT'  ) 

$ INCLUDE ( ' ^/INCLUDE/SSDATA17 .DAT'  ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA18  .DAT' ) 
$INCLUDE(  '''/INCLUDE/SSDATA21  .D.z^T' ) 

$  INCLUDE  ( '  ''/INCLUDE/3SDATA22  .DAT  ' ) 

$  INCLUDE  ( '  ''/IKCLUDE/SSDATA23  .DAT  ' ) 

$  INCLUDE  (  '  ''/INCLUDE/SSDATA28  .DAT  ' ) 

$  INCLUDE  (  ' ''/  INCLUDE/SSDATA2  9  .  DAT  ' ) 

$  INCLUDE  ( '  ''/INCLUDE /SSDAT  A3  0  .DAT  ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA71  .DAT  ' ) 
$INCLUDE  ( '  ''/INCLUDE/SSTIMING.DAT  ' ) 

$ INCLUDE ( ' : pfp : INCLUDE/target . f or ' ) 

*  INITIALIZE  80x87 

CALL  CW87 


$INCLUDE('SS.;12.DAT') 


C 

C' 

C 

C 

C 

C 

C 


iai.op_s 

acslev_s 

dtacsa_s 

dtacsa_s 

dtacsa_s 

dtacsa_s 

dtacsb~s 

dtacsb_s 

dtacsb_s 

dtacsb_s 

dtoffv_s 

dtof fv_s 

dtof fv_s 

dtoffv_s 

ithres  s 


-  idrop 
=  acslev 

(1)  =  dtaesa (1) 

(2)  =  dtaesa  (2) 

(3)  =  dtaesa (3) 

(4)  =  dtaesa  (4) 

(1)  =  dtaesb(l) 

(2)  =  dtaesb(2) 

(3)  =  dtaesb(3) 

(4)  =  dtaesb(4) 

(1)  =  dtoffv(l) 

(2)  =  dtoffv(2) 

(3)  =  dtoffv(3) 

(4)  =  dtoffv(4) 
=  ithres 


ives_s  =  ivcs 
ivtab_s  =  ivtab 
tatab_s  =  tatab 
tburnm_s  =  tbnrnm 
tinonv_s  =  timonv 
tofflt_s (1)  =  tofflt (1) 
tofflt_s  ,;2)  =  tofflt  (2) 
tofflt_s(3)  =  tofflt (3) 
tofflt_s(4)  =  tofflt (4) 
tvtab  s  =  tvtab 


MAIN  EXECUTION  LOOP 


Exeeution  of  all  events  is  performed 
wiL''in  this  loop 
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1000  CONTINUE 

C  WRITE  (*,*)' - BEGINNING  OF  LOOP 


Processor  communication 


-  COMMUNICATION  WITH  SEEKER  ■ 

call  receive_real_32bit (  lamm(l)  ) 
call  receive_real_32bit (  lamm(2)  ) 
call  receive_real_32bit (  snr  ) 
call  receive_real_32bit {  frmrat  ) 

-  COMMUNICATION  WITH  P03  - 

CALL  RECEIVE_SIGNED_16BIT (  IRESLV  ) 

CALL  RECEIVE_REAL_32BIT (  LAMDXX(Ol)  ) 

CALL  RECEIVE_REAL_32BIT{  LAMDXX(02)  ) 
call  receive_real_32bit (  lamsek(l)  ) 
call  receive_real_32bit (  lamsek(2)  ) 
call  receive_real_32bit  (  rnagrtr  ) 

-  DAISY  CHAIN  KITH  IMUPRO  AND  NAVIG 

CALL  RECEIVE_REAL_32BIT(  TI2M(1)  ) 

CALL  RECEIVE_REAL_32BIT (  TI2M(2)  ) 

CALL  RECEIVE_REAL_32BIT (  TI2M(3)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(4)  ) 

CALL  RECEIVE_REAL_32BIT (  TI2M(5)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(6)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(7)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(8)  ) 

CALL  RECEIVE_REAL_32BIT(  TI2M(9)  ) 

CALL  RECEIVE_REAL_32BIT(  VREL(l)  ) 

CALL  RECEIVE_REAL_32BIT(  VREL(2)  ) 

CALL  RECEIVE_REAL_32BIT(  VREL(3)  ) 

CALL  RECEIVE_REAL_32BIT(  RREL(l)  ) 

CALL  RECEIVE_REAL_32BIT(  RREL(2)  ) 

CALL  RECEIVE  REAL  32BIT(  RREL(3)  ) 


KALMAN  FILTER  MODULE 


Filter  LOS  angles 


call  receive_real_32bit (  magr  ) 
call  receive_real_32bit (  magv  ) 
call  receive_  real_32bit (  tgo  ) 
call  receive_real_32bit (  piter  ) 
call  receive_real_32bit (  roller  ) 
call  receive_real_32bit (  yawer  ) 
call  receive_signed_16bit (  iburnl  ) 
call  receive_real_32bit (  lamd(l)  ) 
call  receivo_roal_32bi , {  lamd(2)  ) 
call  receive_signed_16bit (  acqd  ) 

IF  (  TSTEP  .GE.  TKFUDRIV  )  THEN 


284 


onoooo  o  o  oooo 


oo  o  nonoooo 


Appendix  B  -  Exosim  v2.0  Midcoursc  and  Terminial  Phases 


C  TKFUDRIV  =  TKFUDRIV  +  TKFUSTEP 

TKFUDRIV  =  TKFUDRIV  +  int (1000 . 0/f rmrat) 

c  write (message,  103) t 

cl03  format ( '  kalman ' , flO . 4) 

c  call  outmes (message) 

C  CALL  FILTER  IF  SNR  IS  SUFFICIENT 

IF  (  SNR . GE . SNRACQ  .OR.  SEKTYP.NE.2  )  THEN 

IF  (SEKTYP.EQ.l  .OR.  SEKTYP.EQ.2)  THEN 
ASIG  =  (32. 56*SNR**(-0. 29912))*!. OE-6 
ENDIF 

CALL  KALMAN (T, TI2M, LAMM, ASIG,  SNR,  TGO,  RREL,  VREL, 

TI2M, RACQ, MAGRTR,MAGR,MAGV, LAMSEK, LAMDXX, FRMRAT, CMS, 
MACQ, MCSO, MTERM, IRESLV, TRACK, TERM, TRMTGO, TGEl , 
TGE2AL, WFILT, ZFILT, LAM, LAMD, IBURNl, ACQD, ESTATE, 
PITER, YAWER, ROLLER) 


ENDIF 

ENDIF 

call  send_signed_16bit (  estate  ) 
call  send_real_32bit (  piter  ) 
call  send_real_32bit (  roller  ) 
call  send_real_32bit (  yawer  ) 
call  send_signed_16bit (  iburnl  ) 
call  send_real_32bit (  lamd(l)  ) 
call  send_real_32bit (  lamd(2)  ) 
call  send_signed_l6bit (  acqd  ) 
call  send_real_32bit (  tgel  ) 
call  send_real_32bit (  tge2al  ) 
call  send_real_32bit (  trmtgo  ) 


TERMINATION  LOGIC 


Defines  the  simulation  termination 
conditions 


INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  ) 
lEXIT  =  0 

ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED 

IF  (  T.GE.TFINAL  )  THEN 
lEXIT  =  1 
ENDIF 

C  increment  time 

TSTEP  =  TSTEP  +  l.OEO 
T  =  TSTEP  *  DELT 

C  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HA^E  BEEN  MET 
IF  (  lEXIT.EQ.O  )  GO  TO  1000 
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B.2  Utilities  (FORTRAN) 
B.2.1  Sskvauto.for 


Omitted  -  Classified 
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B.2.2  Ssvcsiog.for 


Omitted 


Classified 
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B.2,3  Uuaccel.i  ir 


SUBROUTINE  ACCEL  (T,  UD,  VD,  WD,  P,  Q,  R,  PD,  QD,  RD,  CG,  CIM,  XD,  YD,  ZD,  GR, 
GYSESD, QFRACA, PULSEA) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 

FUNCTION  : 


CALLED  FROM  : 
SUBROUTINES  CALLED 
INPUTS  : 

OUTPUTS  : 

BOTH  : 

UPDATES  : 


ACCEL 

D.  C.  FOREMAN 

ACCELEROMETER  MODEL  COMPUTES  SENSED  DELTA 
VELOCITY  COUNTS.  INCLUDES  ROTATIONAL 
EFFECTS,  AXIS  MISALIGNMENT  AND  NONORTHOGON¬ 
ALITY  ERRORS,  SCALE  FACTOR  ERRORS,  RANDOM 
AND  CONSTANT  DRIFT  AND  QUANTIZATION. 

FORTRAN  MAIN 


NORM 


RESP2R 


T,UD,VD,WD,P,Q,R,PD,QD,RD,CG,CIM,XD, 

YD,ZD,GR 

NONE 

GYSEED, QFRACA,  PULSEA 


T. 

THORNTON 

- 

CR 

# 

004 

T. 

THORNTON 

- 

CR 

# 

016 

B. 

HILL 

- 

CR 

# 

020 

D. 

SMITH 

- 

CR 

# 

021 

B. 

HILL 

- 

CR 

# 

022 

B. 

HILL 

- 

CR 

# 

030 

T. 

THORNTON 

- 

CR 

# 

037 

B. 

HILL 

- 

CR 

# 

038 

D. 

SMITH 

- 

CR 

# 

059 

D. 

SISSOM 

- 

CR 

# 

069 

D. 

SMITH 

- 

CR 

# 

070 

D. 

SMITH 

- 

CR 

# 

075 

D. 

SMITH 

- 

CR 

# 

076 

B. 

HILL  / 

- 

CR 

# 

081 

R. 

RHYNE 

R. 

RHYNE 

- 

CR 

# 

084 

R. 

RHYNE 

- 

CR 

# 

087 

B. 

HILL 

- 

CR 

# 

093 

IMPLICIT  DOUBLE  PRECISION 

(A-H) 

IMPLICIT  DOUBLE  PRECISION 

(0-Z) 

DOUBLE 

PRECISION 

ABIO (3) 

,  ABI1(3) 

,  ABI2(3) 

DOUBLE 

PRECISION 

ABOO (3) 

,  AB01(3) 

,  AB02(3) 

DOUBLE 

PRECISION 

CG<3) 

,  CIM(9) 

,  DCA(3) 

DOUBLE 

PRECISION 

DUMl (3) 

,  DUM2(3) 

,  DUM3(3) 

DOUBTjE 

PRECISION 

DVEL (3) 

,  GR(3> 

,  GPJ\VC(3) 

DOUBLE 

PRECISION 

GRLST(3) 

,  LIMU(3) 

,  PULSEA (3) 

DOUBLE 

PRECISION 

QFRACA (3) 

,  SF1A(3) 

.  SF2A(3) 

DOUBLE 

PRECISION 

SFEA(3) 

.  WDRA(3) 

DOUBLE 

PRECISION 

XIMU(3) 

,  XYZDP(3) 
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INTEGER* 4  GYSEED 

LOCAL  COMMON  USED  FOR  CONSTANTS, LOCAL  VARIABLES  AND 
INITIALIZATION  FLAG 

SAVE  lACCEL 

C  COMMON  "RACCEL"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RACCEL  /  DRSIGA,  PSIA  ,  THTA  ,  PHIA  ,  THXZA  , 

THXYA  ,  THYZA  ,  THYXA  ,  THZYA  ,  THZXA  , 

SFIA  ,  SF2A  ,  DCA  ,  TOACCE  ,  GRLST  , 

XYZDP  ,  ABI2  ,  ABIl  ,  AB02  ,  ABOl 

*  DATA  INITIALIZATION 

Sinclude  ( '  ■'/include/ssdatalS  .dat ' ) 

Sinclude  ( '  ''/include/ssdatal6  .dat ' ) 

DATA  lACCEL  /  1  / 

IF  (lACCEL  .EQ.  1)  THEN 
lACCEL  =  0 

C  INITIALIZE  ACCELEROMETER  PARAMETERS 

IF  (  T  .EQ.  0.0  )  THEN 

DRSIGA  =  DRSGAI/ (60.0*DSQRT(DTIMU) ) 

CALL  NORM (ALNSGA, ALNMNA, GYSEED, PSIA) 

CALL  NORM (ALNSGA, ALNMNA, GYSEED, THTA) 

CALL  NORM (ALNSGA, ALNMNA, GYSEED, PHIA) 

CALL  NORM (AORSGA, AORMNA, GYSEED,  THXZA) 

CALL  NORM (AORSGA, AORMNA,  GYSEED,  THXYA) 

CALL  NORM (AORSGA, AORMNA, GYSEED, THYZA) 

CALL  NORM (AORSGA, AORMNA, GYSEED, THYXA) 

CALL  NORM (AORSGA, AORMNA, GYSEED, THZYA) 

CALL  NORM (AORSGA, AORMNA, GYSEED, THZXA) 

CALL  N0RM(SF1SGA,SF1MNA, GYSEED, SFlA(l) ) 

CALL  N0RM(SF1SGA,SF1MNA, GYSEED, SFIA (2) ) 

CALL  N0RM(SF1SGA, SF1MNA,GYSEED,SF1A(3) ) 

CALL  NORM (SF2SGA,SF2MNA, GYSEED, SF2A(1) ) 

CALL  NORM (SF2SGA,SF2MNA, GYSEED, SF2A (2) ) 

CALL  NORM(SF2SGA, SF2MNA, GYSEED, SF2A(3) ) 

CALL  NORM (DCSIGA, DCMENA, GYSEED, DCA ( 1 ) ) 

CALL  NORM (DCSIGA, DCMENA, GYSEED, DCA (2) ) 

CALL  NORM (DCSIGA, DCMENA, GYSEED, DCA (3) ) 

DO  10  I  =  1,3 

ABI2 (I)  =  O.ODO 
ABIl (I)  =  O.ODO 
AB02(I)  =  O.ODO 
ABOl (I)  =  O.ODO 
10  CONTINUE 

ENDIF 

C  COMPUTE  SECOND  ORDER  RESPONSE  DIFFERENCE  EQUATION  COEFFICIENTS 
IF  (  IARTYP.EQ.2  )  THEN 

CALL  RESP2R  (  DTIMU, WACC, ZACC,  CABI2, CABIl, CABIO, CAB02, 
CABOl,CABO0  ) 

ENDIF 

ENDIF 

C  CALCULATE  TIME  SINCE  LAST  CALL  TO  ACCEL 
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DTDEL  =  T  -  TOACCE 
TOACCE  =  T 

C  DETERMINE  INERTIAL  FRAME  DELTA  VELOCITY  OVER  PREVIOUS  INTERVAL 
WITH 

C  GRAVITIONAL  CONTRIBUTION  REMOVED 

IF  (  DTDEL. NE.O.ODO  )  THEN 

GRAVG(l)  =  0.5D0  *  (  GR(1)  +  GRLST(l)  ) 

GRAVG(2)  =  0.5D0  *  (  GR(2)  +  GRLST(2)  ) 

GRAVGO)  =  0.5D0  *  (  GR{3)  +  GRLST(3)  ) 

DLVXI  =  XD  -  XYZDP(l)  -  DTDEL*GRAVG ( 1 ) 

DLVYI  =  YD  -  XYZDP(2)  -  DTDEL*GRAVG (2 ) 

DLVZI  =  ZD  -  XYZDP(3)  -  DTDEL*GRAVG (3) 

ENDIF 

C  SAVE  GRAVITY  VECTOR  FOR  USE  ON  NEXT  PASS 

GRLSTd)  =  GR(1) 

GRLST(2)  =  GR(2) 

GRLST(3)  =  GR(3) 

C  ROTATE  DELTA  VELOCITY  INTO  MISSILE  FRAME 

IF  {  DTDEL. NE.O.ODO  )  THEN 

DLVXB  =  CIM(1)*DLVXI  +  CIM(4)*DLVYI  +  CIM(7)*DLVZI 

DLVYB  =  CIM(2)*DLVXI  +  CIM(5)*DLVYI  +  CIM(8)*DLVZI 

DLVZB  =  CIM(3)*DLVXI  +  CIM(6)*DLVYI  +  CIM(9)*DLVZI 

ENDIF 

C  CONVERT  DELTA  VELOCITY  TO  AVERAGE  ACCELERATION 

IF  (  DTDEL. NE.O.ODO  )  THEN 
UDAVG  =  DLVXB  /  DTDEL 

VDAVG  =  DLVYB  /  DTDEL 

WDAVG  =  DLVZB  /  DTDEL 

ELSE 

UDAVG  =  UD 

VDAVG  =  VD 

WDAVG  =  WD 

ENDIF 

C  SAVE  PREVIOUS  INERTIAL  FRAME  VELOCITY 

XYZDP(l)  =  XD 
XYZDP(2)  =  YD 
XyZDP(3)  =  ZD 

C  SENSOR  ACCELERATION  DUE  TO  PACKAGE  OFFSET  FROM  THE  CG 

IF  (  IMUOFF.EQ.O  )  THEN 
UDR  =  UDAVG 

VDR  =  VDAVG 

WDR  =  WDAVG 

ELSE 

XIMU(l)  =  CG{1)  -  LIMU(l) 

XIMU(2)  =  CG(2)  -  LIMU(2) 

XIMU(3)  =  CG(3)  -  LIMU(3) 

DUMl(l)  =  QD*XIMU(3)  -  RD*XIMU(2) 

DUM1(2)  =  RD*XIMU(1)  -  PD*XIMU(3) 

DUM1(3)  =  PD*XIMU(2)  -  QD*XIMU(1) 

DUM2{1)  =  Q*XIMU(3)  -  R*XIMU(2) 
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DUM2(2)  =  R*XIMU{1)  -  P*XIMU(3) 

DUM2(3)  =  P*XIMU(2)  -  Q*XIMU(1) 

DUM3(1)  =  Q*DUM2(3)  -  R*DUM2 (2) 

DUM3(2)  =  R*DUM2(1)  -  P*DUM2 (3) 

DUM3(3)  =  P*DUM2(2)  -  Q*DUM2(1) 

UDR  =  UDAVG  +  DUMl(l)  +  DUM3<1) 

VDR  =  VDAVG  +  DUM1(2)  +  DUM3(2) 

WDR  =  WDAVG  +  DUM1(3)  +  DUM3(3) 

ENDIF 

C  ACCELEROMETER  AXIS  MISALIGNMENT  EFFECTS 

UDM  =  UDR  +  VDR*PSIA  -  WDR*THTA 

VDM  =  -  UDR*PSIA  +  VDR  +  WDR*PHIA 

WDM  =  UDR*THTA  -  VDR*PHIA  +  WDR 

C  ACCELEROMETER  AXIS  NONORTHOGONALITY  EFFECTS 

UDN  =  UDM  +  VDM*THXZA  -  WDM*THXYA 

VDN  =  -  UDM*THYZA  +  VDM  +  WDM*THYXA 

WDN  =  UDM*THZYA  -  VDM*THZXA  +  WDM 

C  ADD  LINEAR  AND  QUADRATIC  SCALE  FACTOR  ERRORS 

SFEA(l)  =  UDN  +  SF1A(1)*UDN  +  SF2A(1) *UDN**2 

SFEA(2)  =  VDN  +  SF1A(2)*VDN  +  SF2A(2) *VDN**2 

SFEA(3)  =  WDN  +  SF]A(3)*WDN  +  SF2A(3) *WDN**2 

C  FOR  EACH  AXIS  . . . 

DO  20  1=1,3 

C  MAKE  A  GAUSSIAN  DRAW  FOR  RANDOM  DRIFT  AND  ADD  TO  CONSTANT  DRIFT 

IF  (  DRSIGA.GT.O.ODO  )  THEN 

CALL  NORM(DRSIGA,DRMENA,GYSEED,DRA) 

ENDIF 

WDRA(I)  =  DRA  +  DCA(I) 

C  COMPUTE  INPUT  TO  ACCELEROMETER  RESPONSE  MODEL 

ABIO(I)  =  SFEA(I)  +  WDRA(I) 

C  SECOND  ORDER  RESPONSE  MODEL 

IF  (  IARTYP.EQ.2  )  THEN 

ABOO(I)  =  (  CABI0*ABI0 (I)  +  CABI1*ABI1 (I) 

+  CABI2*ABI2 (I)  -  CAB01*AB01 (!) 

-  CAB02*AB02 (I)  ) /CABOO 
ABI2  (I)  =  ABIl (I) 

ABIl(I)  =  ABIO(I) 

AB02 (I)  =  ABOl (I) 

ABOl(I)  =  ABOO(I) 

ENDIF 

C  INSTANTANEOUS  RESPONSE  MODEL 

IF  (  lARTYP.EQ.O  )  THEN 
ABOO(I)  =  ABIO(I) 

ENDIF 
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C 


C 


C 


COMPUTE  SENSED  DELTA  VELOCITY 
DVEL(I)  =  DTDEL  *  ABOO(I) 

IF  (  SPPA.GT.0.0  )  THEN 

UNQUANTIZED  OUTPUT  IN  COUNTS 

QFRACA(I)  =  QFRACA(I)  -  PULSEA(I)  +  DVEL(I)/SPPA 
QUANTIZED  OUTPUT  IN  COUNTS 
PULSEA(I)  =  DINT(QFRACA(I) ) 

ELSE 

PULSEAd)  =  DVEL(I) 

END  IF 

20  CONTINUE 

RETURN 

END 
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B.2.4  Uuacsth2.for 


IF  (ITHRES  .EQ.  1)  THEN 

ITHRES  =  0 

ENDIF 

RETURN 

END 
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B.2.5  Uuacsthr.for 

c - 

SUBROUTINE  ACSTHR (T,  CG,  ACSLEV,  DTACSA,  DTACSB,  TATAB,  TOSEED, TBRK, 
ITHRES,FXACS,FYACS,F2;ACS,MXACS,MYACS,MZACS, 
MDOTA, lACSON, TIMONA) 


SUBROUTINE  NAME  :  ACSTHR 

AUTHOR (S)  :  B.  HILL 

FUNCTION  :  RESOLVES  THE  ACS  THRUSTER  BURN  TIMES  INTO 

THE  APPROPRIATE  FORCES  AND  MOMENTS 

CALLED  FROM  ;  FORTRAN  MAIN 

SUBROUTINES  CALLED  NORM,  TABLE 

INPUTS  :  T,CG, ACSLEV, DTACSA, DTACSB, TATAB 

OUTPUTS  :  FXACS,FYACS,FZACS,MXACS,MYACS,M2ACS, MDOTA, 

lACSON, TIMONA 

BOTH  ;  TOSEED, TBRK, ITHRES 

UPDATES  :  D.  SISSOM  -  CR  #  017 

D.  SISSOM  -  CR  #  032 

B.  HILL  -  CR  #  038 

T.  THORNTON  -  CR  #  043 

B.  HILL  -  CR  #  051 

D.  SMITH  -  CR  #  059 

D.  SISSOM  -  CR  #  069 

D.  SMITH  -  CR  #  074 

D.  SMITH  -  CR  #  076 

D.  SMITH  -  CR  #  080 

B.  HILL  /  -  CR  #  081 

R.  RHYNE 

D.  SMITH  -  CR  #  082 

R.  RHYNE  -  CR  #  083 

R.  RHYNE  -  CR  #  084 

B.  HILL  -  CR  #  086 

R.  RHYNE  -  CR  #  087 

B.  HILL  -  CR  #  089 

B.  HILL  -  CR  #  093 


IMPLICIT  REAL 

(A-H) 

IMPLICIT  REAL 

(0-Z) 

REAL 

ACSDIR(3,  4) 

,  ACSLOC(3,4) 

t 

ACSMA(9, 4) 

REAL 

AOFFl(4) 

,  AOFF2(4) 

f 

ATHRA ( 4 ) 

REAL 

ATHRB(4) 

,  CG(3) 

t 

DTACSA (4) 

REAL 

DTACSB (4) 

,  F(3) 

/ 

F0(3) 

REAL 

ISPACS 

,  M(3) 

t 

MDOTA 

REAL 

MX  ACS 

,  MYACS 

t 

MZACS 

REAL 

THACSA(8, 4) 

,  THACSB(8,4) 

f 

TMACSA(S,  4 

REAL 

TMACSB(8, 4) 

,  XMOM(3) 

INTEGER 

INDXA(4) 

INTEGER 

INDXB(4) 

INTEGER 

LENA  (4)  , 

LENB  ( 4 ) 
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INTEGER* 4  TOSEED 

C  LOCAL  COMMON  USED  FOR  CONSTANTS,  LOCAL  VARIABLES  AND 
C  INITIALIZATION  FLAG 

SAVE  lACSTH  ,  ACSMA 

C  COMMON  "RACSTR"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RACSTR  /  TREFLA  ,  TLSTC  ,  ACSF  ,  AOFFl  ,  AOFF2  , 

TMACSA  ,  THACSA  ,  LENA  ,  TMACSB  ,  THACSB  , 

LENB 

*  DATA  INITIALIZATION 
$  INCLUDE  ( '  /  INCLUDE/ SSDATAOl  .DAT  ' ) 

$ INCLUDE ( ' "/INCLUDE/SSDATA02 . DAT ' ) 

SINCLUDE  ( '  ''/INCLUDE/SSDATA03  .DAT ' ) 

$INCLUDE ( ' "/INCLUDE/SSDATA17 .DAT' ) 

SINCLUDE  (  '  ''/INCLUDE/SSDATA18  .DAT  ' ) 

$  INCLUDE  ( ' ''  /  INCLUDE  /  SSDATAl  9  .  DAT ' ) 

$  INCLUDE  INCLUDE/  SSDATA2  0  .  DAT  • ) 

DATA  lACSTH  /  1  / 

IF  (  lACSTH.EQ.l  )  THEN 

lACSTH  =  0 

IF  (T  ,LT.  TKVON+EPSL)  THEN 

C  ACS  MISALIGNMENT  DIRECTIONS 

C  AOFFl  =  CONS  ANGLE  OFF  NORMAL 

C  AOFF2  =  POLAR  ANGLE 

CALL  spNORM ( AOFFSD, 0 . OeO, TOSEED, AOFFl ( 1 ) ) 

CALL  spNORM(AOFFSD,0. OeO, TOSEED, AOFFl (2) ) 

CALL  spNORM (AOFFSD, 0. OeO, TOSEED, AOFFl (3) ) 

CALL  spNORM (AOFFSD, 0. OeO, TOSEED, AOFFl (4) ) 

AOFF2(l)  =  2.0*PI*spRAN0(TOSEED) 

AOFF2(2)  =  2. 0*PI*SpRAN0 (TOSEED) 

AOFF2(3)  =  2. 0*PI*spRAN0 (TOSEED) 

AOFF2(4)  =  2.0*PI*SpRAN0(TOSEED) 

ENDIF 

DO  300  I  =  1  ,  4 

CAOFFl  =  COS (AOFFl (I) ) 

SAOFFl  =  SIN (AOFFl (I) ) 

CAOFF2  =  COS(AOFF2 (I) ) 

SAOFF2  =  SIN(AOFF2 (I) ; 

ACSMA(1,I)  =  CAOFFl 
ACSMA(2,I)  =  SAOFFl*CAOFF2 
ACSMA(3,I)  =  SAOFFl*SAOFF2 
ACSMA(4,I)  =  SAOFFl*SAOFF2 
ACSMA (5, I)  =  CAOFFl 
ACSMA(6,I)  =  SAOFFl*CAOFF2 
ACSMA (7, I)  =  SAOFFl *CAOFF2 
ACSMA (8, I)  =  SAOFFl *SAOFF2 
ACSMA (9, I)  =  CAOFFl 
300  CONTINUE 

ENDIF 


296 


oo  o  non  non 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Tcrminial  Phases 


C  RESET  THE  FORCE  AND  MOMENT  COUNTERS  TO  ZERO 

FXACS  =0.0 
FYACS  =0.0 
FZACS  =0.0 
MXACS  =0.0 
MYACS  =0.0 
MZACS  =0.0 
MDOTA  =0.0 

IF  (ITHRES  .EQ.;  1)  THEN 

CALCULATE  TIME  FOR  PULSE  TO  COME  ON  AND  TIME  FOR  PULSE  TO 
REACH  FULL  FORCE  LEVEL 

TIMONA  =  TATAB  +  TLAGA 
TUPA  =  TIMONA  +  TRUPA 

DETERMINE  APPROPRIATE  MAXIMUM  THRUST  LEVEL 

IF  (ACSLEV  .GT.  1.5)  THEN 
ACSF  =  ACSFH 
ELSE 

ACSF  =  ACSFL 
END  IF 

DO  101  1=1,4 

INITIALIZE  TABLE  POINTERS 

INDXA(I)  =  1 
INDXBd)  =  1 

CALCULATE  THRUSTER  RESPONSE  TABLE  FOR  "A"  THRUSTERS 

CALL  spTABLE(TMACSA(l,I),THACSA(l,I) , TATAB, THAI, LENA ( I) , 
INDXA(I) ) 

IF  (DTACSA(I)  .GE.  TCMINA)  THEN 
IF  (THAI  .LT..  EPSL)  THEN 

PREVIOUS  VALVE  STATE  WAS  LOW 


TMACSA (1,1)  =  TATAB 
THACSA(1,I)  =0.0 
TMACSA (2, I)  =  TIMONA 
THACSA(2,I)  =0.0 
TMACSA (3, I)  =  TUPA 
THACSA(3,I)  =  ACSF 
IPTR  =  4 
ELSE 

CALL  spTABLE  (TMACSA  (1,  I)  ,  TMACSA  ( 1 , 1 TIMONA,  THA2  , 
LENA(I) , INDXA(I) ) 

IF  (THA2  .LT.  EPSL)  THEN 

PREVIOUS  VALVE  STATE  WAS  EITHER  DELAY  OR  RAMP, 
AND  NO  CRO.SS-OVER  IS  PRESENT 


TMACSA (1, I) 
THACSAd,  I) 
TMACSA(2, I) 
THACSA(2, I) 
TMACSA(3,I) 
THACSA(3, I) 
TMACSA(4, I) 


=  TMACSA ( LENA (I) -3, I) 
=  THACSA(I.F.NA(I)-3,  I) 
=  TMACSA(LENA(I)-2,I) 
=  THACSA(LENA(I) -2, I) 
=  TMACSA (LENA (I ) -1, I) 
=  THACSA(LENA(I) -1, I) 
=  TIMONA 
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THACSA(4,I)  =  0.0 
TMACSA(5,I)  =  TUP A 
THACSA(5,I)  =  ACSF 
IPTR  =  6 
ELSE 

CALL  spTABLE ( TMACSA (1,1), THACSA (1,1), TUP A, THA3 , 
LENA(I) , INDXA(I) ) 

IF  (THA3  .GE,  (ACSF-EPSL) )  THEN 

C  PREVIOUS  VALVE  STATE  WAS  HIGH 

TMACSA (1,1)  =  TATAB 
THACSA (1,1)  =  ACSF 
IPTR  =  2 
ELSE 

PREVIOUS  VALVE  STATE  WAS  DELAY,  AND  A 
CROSS-OVER  CONDITION  HAS  OCCURED 

TMACSAd,!)  =  TMACSA(LENA(I) -3,  I) 

THACSAd,!)  =  THACSA(LENA(I)-3,I) 

TMACSA(2,I)  =  TMACSA (LENA ( I) -2, I) 

THACSA(2,I)  =  THACSA(LENA(I) -2, I) 

TMACSA(3,I)  =  (TMACSA(LENA(I) -1, I)  +TIMONA)/2.0 
THACSA (3. I)  =  (TMACSA (3, I)  -  TIMONA) *ACSF/TRDNA 
TMACSA (4, I)  =  TUP A 
THACSA (4, I)  =  ACSF 
IPTR  =  5 
END  IF 
ENDIF 
ENDIF 

TMACSA  (IPTR,  I)  =  TIMONA  +  DTACSAd) 

THACSA (IPTR, I)  =  ACSF 

TMACSA (IPTR+1, I)  =  TMACSA (IPTR, I)  +  TRDNA 
THACSA (IPTR+1, I)  =0.0 
TMACSA (IPTR+2, I)  =  999.0 
THACSA (IPTR+2, I)  =  0.0 
LENA ( I)  =  IPTR+2 
ELSE 

MAKE  SURE  VALVE  IS  OFF 

IF  (THAI  .LT.  EPSL)  THEN 

PREVIOUS  VALVE  STATE  WAS  LOW 

TMACSAd,!)  =  TATAB 
THACSAd,!)  =0.0 
TMACSA(2,I)  =  999.0 
THACSA (2, I)  =0.0 
LENA(I)  =  2 
ELSE 

CALL  spTABLE  (TMACSAd,  I)  ,  THACSAd,  I)  ,TUPA,THA3, 

LENA(I)  ,  INDXAd)  ) 

IF  (THA3  .LT.  EPSL)  THEN 

PREVIOUS  VALVE  STATE  WAS  EITHER  DELAY  OR  RAMP,  WITH 
NO  CROSSOVER  POSSIBLE 

Ti-iACSA(l,I)  =  TMACSA(LENA(I) -3,  I) 

THACSAd,!)  =  THACSA(LENA(I) -3, 1) 

TMACSA(2,I)  =  TMACSA(LENA(I) -2, I) 

THACSA(2,I)  =  THACSA (LENA (I) -2, I) 

TMACSA(3,I)  =  TMACSA(LENA(I) -1, I) 
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THACSA(3,I)  =  THACSA(LENA(I) -1, I) 

TMACSA(4,I)  =  999.0 
THACSA(4,I)  =  0.0 
LENA (I)  =  4 
ELSE 

PREVIOUS  VALVE  STATE  WAS  DELAY,  AND  CROSSOVER  COULD 
OCCUR 

TMACSA(1,I)  =  TATAB 
THACSA(1,I)  =  ACSF 
TMACSA(2,I)  =  TIMONA 
THACSA(2,I)  =  ACSF 
TMACSA(3,I)  =  TIMONA  +  TRDNA 
THACSA(3,I)  =0.0 
TMACSA{4,I)  =  999.0 
THACSA(4,I)  =  0.0 
LENA(I)  =  4 
END  IF 
ENDIF 
END  IF 

CALCULATE  THRUSTER  RESPONSE  TABLE  FOR  "B"  THRUSTERS 

CALL  spTABLE(TMAC£B(l, I) ,THACSB(1, I) , TATAB, THBl, LENB ( I) , 
INDXBd)  ) 

IF  (DTACSB(I)  .GE.  TCMINA)  THEN 
IF  (THBl  .LT.  EPSL)  THEN 

PREVIOUS  VALVE  STATE  WAS  LOW 

TMACSB(1,I)  =  TATAB 
THACSBd,!)  =  0.0 
TMACSB(2,I)  =  TIMONA 
THACSB(2,I)  =  0.0 
TMACSB(3,I)  =  TUPA 
THACSB(3,I)  =  ACSF 
IPTR  =  4 
ELSE 

CALL  spTABLE{TMACSBd,  I)  , THACSBd,  I)  ,  TIMONA,  THB2, 

LENB  (I)  ,  INDXBd)  ) 

IF  (THB2  .LT.  EPSL)  THEN 

PREVIOUS  VALVE  STATE  WAS  EITHER  DELAY  OR  RAMP, 

AND  NO  CROSS-OVER  IS  PRESENT 

TMACSBd,!)  =  TMACSB(LENBd) -3,  I) 

THACSBd,!)  =  THACSB(LENBd) -3,  I) 

TMACSB(2,I)  =  TMACSB(LENBd) -2,  I) 

THACSB(2,I)  =  THACSB(LENBd) -2,  I) 

TMACSB(3,I)  =  TMACSB(LENBd) -1,  I) 

THACSB(3,I)  =  THACSS(LENBd) -1,  I) 

TMACSB{4,I)  =  TIMONA 
THACSB(4,I)  =0.0 
TMACSP(5,I)  =  TUPA 
THACSB{5,I)  =  ACSF 
IPTR  =  6 
ELSE 

CALL  spTABLE (TMACSB (1,1), THACSB ( ) , T ) , TUPA, THB3 , 
LENBd)  ,  INDXBd)  ) 

IF  (THB3  .GE.  (ACSF-EPSL) )  THEN 

C  PREVIOUS  VALVE  STATE  WAS  HIGH 
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TMACSB(1,I)  =  TATAB 
THACSB(1,I)  =  ACSF 
IPTR  =  2 
ELSE 

PREVIOUS  VALVE  STATE  WAS  DELAY,  AND  A 
CROSS-OVER  CONDITION  HAS  OCCURED 

TMACSBd,!)  =  TMACSB(LENB(I)-3,I) 

THACSBd,!)  =  THACS3{LENB(I) -3, 1) 

TMACSB(2,I)  =  Tt’lACSBiLENBd) -2,  I) 

THACSB<2,I)  =  THACSB(LENB(I)-2,I) 

TMACSB(3,I)  =  (TMACSB(LENB (I) -1, 1)  +  TIMONA) 

/2.0 

THACSB(3,I)  =  (TMACSB(3,I)  -  TIMONA) *ACSF/TRDNA 
TMACSB(4,I)  =  TUPA 
THACSB(4,I)  =  ACSF 
IPTR  =  5 
ENDIF 
END  IF 
ENDIF 

TMACSBdPTR,  I)  =  TIMONA  +  DTACSBd) 

THACSBdPTR,  I)  =  ACSF 

TMACSB (IPTR+1, I)  =  TMACSB ( IPTR, I )  +  TRDNA 
THACSB (IPTR+l, I)  =0.0 
TMACSB dPTR+2, I)  =  999.0 
THACSB dPTR+2, I)  =0.0 
LENBd)  =  IPTR+2 
ELSE 

MAKE  SURE  VALVE  IS  OFF 

IF  (THBl  ,LT.  EPSL)  THEN 

PREVIOUS  VALVE  STATE  WAS  LOW 

TMACSBd,!)  =  TATAB 
THACSBd,!)  =0.0 
TMACSB(2,I)  =  999.0 
THACSB (2, I)  =0.0 
LENBd)  =  2 
ELSE 

CALL  SpTABLE (TMACSB (1, I) , THACSB (1,1), TUPA, THB3, 

LENBd)  ,  INDXBd)  ) 

IF  (THB3  .LT.  EPSL)  THEN 

PREVIOUS  VALVE  STATE  WAS  EITHER  DELAY  OR  RAMP,  WITH 
NO  CROSSOVER  POSSIBLE 

TMACSBd,!)  =  TMACSB{LENBd)-3,I) 

THACSBd,!)  =  THACSB  (LENBd) -3,  I) 

TMACSB(2,I)  =  TMACSB(LENB(I) -2, I) 

THACSB(2,I)  =  ■^HACSB(LENB  (I) -2,  I) 

TMACSB(3,I)  =  TMACSB(LENB (I) -1, I) 

THACSB(3,I)  =  THACSB(LENB(I) -1, I) 

TMACSB(4,I)  =  999.0 
THACSB(4,I)  =  0.0 
LENB(I)  =  4 
ELSE 

PREVIOUS  VALVE  STATE  WAS  DELAY,  AND  CROSSOVER  COULD 
OCCUR 

TMACSBd,!)  =  TATAB 
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THACSBd,  I) 

= 

ACSF 

TMACSB(2,  I) 

TIMONA 

THACSB(2,  I) 

=: 

ACSF 

TMACSB(3,I) 

= 

TIMONA  +  TRDNA 

THACSB(3,  I) 

= 

0.0 

TMACSB(4,  I) 

= 

999.0 

THACSB(4,  I) 

= 

0.0 

LENBd)  =  4 

ENDIF 

ENDIF 

ENDIF 

CONTINUE 

ENDIF 

C  SET  REFERENCE  TIME  FOR  TABLE  LOOKUPS  AND  RESET  ACS  "ON"  FLAG 


TREF  =  T 
lACSON  =  0 

CALCULATE  AVERAGE  THRUST  LEVELS  FOR  EACH  "A"  THRUSTER 
DURING  NEXT  CYCLE 


DO  20  I  =  1  ,  4 

INITIALIZE  TABLE  POINTER 
INDXA(I)  =  1 

COMPUTE  INSTANTANEOUS  THRUST  LEVEL  VIA  TABLE  LOOKUP  IF  ACS  "A" 
CYCLE  IS  SCHEDULED  FOR  THIS  THRUSTER  .  ALSO  EXTRAPOLATE  TIME  OF 
NEXT  ACS  "A"  TABLE  LOOKUP  INDEX  TRANSITION  . 

IF  (  TMACSAd,  I)  .GT.O.OeO  )  THEN 

CALL  spTABLE  (TMACSAd,  I)  ,THACSA(1,  I )  ,  TREF,  ATHRA (1)  , 

LENA(I) , INDXA(I) ) 

IF  (  ATHRA (I)  .GE.  ACSF-EPSL  )  lACSON  =  1 
ELSE 

ATHRA (1)  =  O.OeO 
INDXA(I)  =  0 
ENDIF 

CALCULATE  THE  FORCES  AND  MOMENTS  PRODUCED  BY  THE  "A" 

ACS  THRUSTERS  : 

Fd)  IS  THE  FORCE  ALONG  THE  Ith  AXIS. 

XMOMd)  IS  THE  EFFECTIVE  MOMENT  ARM. 

FORCES  ARE  ADJUSTED  FOR  MISALIGNMENT  EFFECTS. 

THE  MOMENT  GENERATED  IS  (  F  x  XMOM  ) . 

DO  10  J=l,3 

F0(J)  =  ACSDIR(J,  I)  *ATHRAd) 

XMOM(J)  =  CG(J)  -  ACSLOC(J, I) 

10  CONTINUE 

Fd)  =  ACSMAd,  I)  *F0  d)  +ACSMA(4,  I)  *F0  (2)  +ACSMA  (7,  I)  *F0  (3) 

F(2)  -  ACSI»1A(2,  I)  *F0  (1)  +ACSMA  ( 5,  I )  *F0  ( 2 )'  +ACSMA  (8,  I)  *F0  (3) 

F(3)  -  ACSM*' (3,  I)  *F0  (1)  +ACSMA(6,  I)  *F0  (2)  +ACSMA  (9,  I)  *F0  (3) 


Md) 

=  F(2) *XMOM(3) 

-  r(3) 

*XMOM(2) 

M(2) 

=  F(3)  *XMOMd) 

-  Fd) 

*XMOM(3) 

M(3) 

=  Fd)  *XMOM(2) 

-  F(2) 

*XMOMd) 

FXACS 

=  FXACS  +  Fd) 

FYACS 

=  FYACS  +  F(2) 

FZACS 

=  FZACS  +  F(3) 
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MXACS  =  MXACS  +  M(l) 

MYACS  =  MYACS  +  M(2) 

MZACS  =  MZACS  +  M(3) 

MDOTA  =  MDOTA  +  ATHRA (I) /ISPACS 

20  CONTINUE 

CALCULATE  AVERAGE  THRUST  LEVELS  FOR  EACH  "B"  THRUSTER 
DURING  NEXT  CYCLE 

DO  40  I  =  1  ,  4 

INITIALIZE  TABLE  POINTERS 

INDXB(I)  =  1 

COMPUTE  INSTANTANEOUS  THRUST  LEVEL  VIA  TABLE  LOOKUP  IF  ACS  "B" 
CYCLE  IS  SCHEDULED  FOR  THIS  THRUSTER  .  ALSO  EXTRAPOLATE  TIME  OF 
NEXT  ACS  "B"  TABLE  LOOKUP  INDEX  TRANSITION  . 

IF  (  TMACSBd,  I)  .GT.O.OeO  )  THEN 

CALL  spTABLE ( TMACSB (1,1), THACSB (1,1), TREE ,  ATHRB ( I ) , 

LENB(I) , INDXB(I) ) 

IF  (  ATHRB (I)  .GE.  ACSF-EPSL  )  lACSON  =  1 
ELSE 

ATHRB (I)  =  O.OeO 
INDXB(I)  =  0 
END  IF 


CALCULATE  THE  FORCES  AND  MOMENTS  PRODUCED  BY  THE  "B" 
ACS  THRUSTERS  : 

F(I)  IS  THE  FORCE  ALONG  THE  Ith  AXIS. 

XMOM(I)  IS  THE  EFFECTIVE  MOMENT  ARM. 

FORCES  ARE  ADJUSTED  FOR  MISALIGNMENT  EFFECTS. 
THE  MOMENT  GENERATED  IS  (  F  x  XMOM  ) . 


DO  30  J=l,3 

F0(J)  =  -ACSDIR(J,I)*ATHRB(I) 

XMOM(J)  =  CG(J)  -  ACSLOC(J,I) 

30  CONTINUE 


F(l) 

F(2) 

F(3) 


ACSMAd,  I)  *F0  (1) 
ACSMA(2, I) *F0(1) 
ACSMA(3, I) *F0 (1) 


+ACSMA(4, I) *F0 (2) 
+ACSMA(5, I) *F0 (2) 
+ACSMA(6, I) *F0 (2) 


+ACSMA(7, I) *F0 (3) 
+ACSMA(8, I) *F0 (3) 
+ACSMA(9, I) *F0 (3) 


M(l) 

M(2) 

M(3) 


F(2) *XMOM(3) 
F(3) *XMOM(l) 
F (1) *XMOM(2) 


-  F(3) *XMOM(2) 

-  F(l) *XMOM(3) 

-  F(2)*XMOMd) 


FXACS  =  FXACS  +  Fd) 

FYACS  =  FYACS  +  F(2) 

FZACS  =  FZACS  +  F(3) 

MXACS  =  MXACS  +  M(l) 

MYACS  =  MYACS  +  M(2) 

MZACS  =  MZACS  +  M(3) 

MDOTA  =  MDOTA  +  ATHRB ( I) /ISPACS 

40  CONTINUE 


RETURN 

END 
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B.2.6  Uubikdat.for 

c - 

BLOCKDATA  BLKDAT 

IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (0-Z) 

COMMON  /  NORCOM  /  GSET  ,  ISET 


COMMON  "RSPLAG"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 


PARAMETER 


(NSAVMX=10) 


DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 


TLATCH(NSAVMX) 

LAMMSV(2,NSAVMX) 

RRELSV(3,NSAVMX) 

VRELSV(3,NSAVMX) 

TI2MSV(9,NSA'/MX) 

SNRSV(NSAVMX) 


COMMON  /  RSPLAG  /  NLATCH  ,  TLATCH  ,  LAMMSV  ,  RRELSV  ,  VRELSV  , 
TI2MSV  ,  SNRSV 

DATA  ISET  /  0  / 

DATA  NLATCH/ 0/ 

END 
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B.2.7  Uubrtavg.for 


SUBROUTINE  BRTAVG(TN, 

TA,DT,W) 

SUBROUTINE  NAME  : 

BRTAVG 

AUTHOR (S)  : 

D.  F.  SMITH 

FUNCTION  : 

Compute  1 

the  average  body  rates 

over  the  last 

interval 

using  the  current  and 

previous 

inertial 

to  missile  transformation  matrices 

CALLED  FROM  ; 

GYRO 

SUBROUTINES  CALLED  : 

M3X3I 

INPUTS  : 

TN,TA,DT 

OUTPUTS  : 

W 

UPDATES  ; 

D.  SMITH 

-  CR  #  076 

IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (0-Z) 

DOUBLE  PRECISION  TN(9),  TA(9),  W(3) 

DOUBLE  PRECISION  TD(9),  TI(9),  TE(9) 

C  COMPUTE  INVERSE  OF  PREVIOUS  TRANSFORMATION  MATRIX 

CALL  M3X3I  (  TA  ,  TI  ) 

C  COMPUTE  DELTA  ROTATION  MATRIX  FROM  PREVIOUS  MISSILE  ATTITUDE  TO 
CURRENT 

C  MISSILE  ATTITUDE 

TD(1)  =  TN(1)*TI(1)  +  TN(4)*TI(2)  +TN(7)*TI(3) 

TD(2)  =TN(2)*TI(1)  +TN(5)*TI(2)  +TN(8)*TI(3) 

TD(3)  =  TN(3)*TI(1)  +  TN(6)*TI(2)  +  TN(9)*TI(3) 

TD(4)  =  TN(1)*TI(4)  +  TN(4)*TI(5)  +  TN(7)*TI(6) 

TD(5)  =  TN(2)*TI(4)  +  TN(5)*TI(5)  +  TN(8)*TI(6) 

TD(6)  =TN(3)*TI(4)  +TN(6)*TI{5)  +TN(9)*TI(6) 

TD{7)  =  TN(1)*TI(7)  +  TN(4)*TI(8)  +  TM(7)*TI(9) 

TD(8)  =  TN(2)*TI(7)  +  TN(5)*TI(8)  +  TN(8)*TI(9) 

TD(9)  =  TN(3)*TI(7)  +  TN(6)*TI(8)  +  TN(9)*TI(9) 

C  DETERMINE  DELTA  EULER  ANGLES  FROM  PREVIOUS  ORIENTATION  (  EULER 
ROTATION 

C  SEQUENCE  IS  PSI-THETA-PHI  ) 

DLPSI  =  DATAN2  (  TD(4)  ,  TD(1)  ) 

DLTHE  =  DASIN  {  -TD(7)  ) 

DLPHI  =  DATAN2  (  TD(8)  ,  TD(9)  ) 

CDLPSI  =  DCOS  (  DLPSI  ) 

SDLPSI  =  DSIN  (  DLPSI  ) 

CDLTHE  =  DCOS  (  DLTHE  ) 

SDLTHE  =  DSIN  {  DLTHE  ) 

CDLPHI  =  DCOS  (  DLPHI  ) 
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SDLPHI  =  DSIN  (  DLPHI  ) 

COMPUTE  MATRIX  RELATING  EULER  ANGULAR  RATES  TO  BODY  RATES  (  [TE] 

USED  FOR  TEMPORARY  STORAGE  ) 

TE(1)  =  l.ODO 

TE(2)  =  O.ODO 

TE(3)  =  O.ODO 

TE(4)  =  O.ODO 

TE(5)  =  CDLPSI 

TE(6)  =  -  SDLPSI 

TE(7)  =  -  SDLTHE 

TE(8)  =  CDLTHE*SDLPHI 

TE(9)  =  CDLTHE*CDLPHI 

C  ADD  IDENTITY  MATRIX  TO  (TE]  AND  INVERT  THE  RESULTANT  MATRIX 

TD{1)  =  TE(1)  +  l.ODO 

TD(2)  =  TE(2) 

TD(3)  =  TE(3) 

TD(4)  =  TE(4) 

TD(5)  =  TE(5)  +  l.ODO 

TD(6)  =  TE(6) 

TD(7)  =  TE<7) 

TD{8)  =  TE(8) 

TD{9)  =  TE(9)  +  l.ODO 

CALL  M3X3I  (  TD  ,  TI  ) 

C  CALCULATE  AVERAGE  BODY  RATES  OVER  LAST  INTERVAL 

TD(1)  =TI(1)*TE(1)  +TI{4)*TE(2)  +TI(7)*TE(3) 

TD(2)  =  TI(2)*TE(1)  +  TI(5)*TE(2)  +  TI(8)*TE(3) 

TD(3)  =  TI{3)*TE(1)  +  TI(6)*TE(2)  +  TI(9)*TE(3) 

TD(4)  =TI(1)*TE(4)  +TI(4)*TE(5)  +TI(7)*TE(6) 

TD(5)  =  TI(2)*TE(4)  +  TI(5)*TE(5)  +  TI(8)*TE(6) 

TD(6)  =  TI(3)*TE(4)  +  TI(6)*TE(5)  +  TI(9)*TE(6) 

TD<7)  =  TI(1)*TE(7)  +  TI(4)*TE(8)  +  TI(7)*TE(9) 

TD(8)  =TI(2)*TE(7)  +TI(5)*TE(8)  +TI{8)*TE(9) 

TD(9)  =TI(3)*TE(7)  +TI(6)*TE(8)  +TI(9)*TE(9) 

W(l)  =  2.0D0  *  (  TD(l)*DLPiII  +  TD(4)*DLTHE  +  TD(7)*DLPSI  )  /  DT 

W(2)  =  2.0D0  *  (  TD(2)*DLPHI  +  TD(5)*DLTHE  +  TD{8)*DLPSI  )  /  DT 

W(3)  =  2.0D0  *  {  TD(3)*DLPHI  +  TD(6)*DLTHE  +  TD(9)*DLPS1  )  /  DT 

RETURN 

END 
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B.2.8  Uucorvel.for 

c - - - 

SUBROUTINE  CORVEL (T, MVR, VTT, RMIR, VMIR, VTTP, VG, VS, MVS, UVS, VC, DLV, 
TFFE,TTFE) 


SUBROUTINE  NAME  :  CORVEL 

AUTHOR (S)  ;  M.  K.  DOUBLEDAY,  L.  C.  HECK 

FUNCTION  :  CALCULATES  THE  CORRELATED  VELOCITY 

CALLED  FROM  :  FORTRAN  MAIN 

SUBROUTINES  CALLED  ;  NONE 

INPUTS  :  T,MVR,VTT, RMIR, VMIR 

OUTPUTS  :  VS,MVS,UVS,VC,DLV,TFFE,TTFE 

BOTH  :  VTTP,VG 

UPDATES  :  T.  THORNTON 

D.  SMITH 
B.  HILL 
T.  THORNTON 
T.-  THORNTON 
T.  THORNTON 
T,  THORNTON 
D.  SMITH 
D,  SMITH 
B.  HILL  / 

R.  RHYNE 
B.  HILL 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (O-Z) 


REAL  VMIR(3)  ,  RMIR{3) 


REAL 

DLV(3) 

,  MDVT 

t 

MRB 

REAL 

MRT 

,  MTMPV 

t 

MVCE 

REAL 

MVR 

,  MVS 

/ 

MVSE 

REAL 

RB(3) 

,  RTPRED(3) 

REAL 

TMPV(3) 

,  URB(3) 

/ 

URT (3) 

REAL 

UTHP (3) 

,  UTMPV(3) 

/ 

UVS (3; 

REAL 

VC{3) 

,  VCE(3} 

REAL 

VDO  (3) 

,  VG(3) 

f 

VGE (3) 

REAL 

VPHI  (3) 

,  vse: 

REAL 

VSE(3) 

,  VTT (3) 

VTTP  (3) 

C  LOCAL  COMMON  USED  FOR  CONSTANTS  AND  INITIALIZATION  FLAG 

SAVE  ICORV 

*  DATA  INITIALIZATION 

SINCLUPE ( ' ^/INCLUDE/SSDATA39 .DAT ' ) 

$  INCLUDE ( ’ "/INCLUDE/SSDATA42 .DAT' ) 

SINCLUDE  ( '  ''/INCLUDE/SSDATA43  .DAT ' ) 

$  INCLUDE  ( '  '^  /  INCLUDE  /  SSDATA2  3  .  DAT  ' ) 


-  CR  #  025 

-  CR  #  013 

-  CR  #  030 

-  CR  #  033 

-  CR  #  042 

-  CR  #  043 

-  CR  #  044 

-  CR  #  059 

-  CR  #  072 

-  CR  #  081 

-  CR  #  093 
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DATA  ICORV  /  1  / 

IF  (ICORV  .EQ.  1)  THEN 
ICORV  =  0 

IF  (T  .EQ.  0.0)  THEN 
ILOOP  =  50 
ELSE 

ILOOP  =  1 
END  IF 
ELSE 

ILOOP  =  1 
ENDIF 

ESTIMATE  VELOCITY  TO  BE  GAINED  (VGE)  ,  CORRELATED  VELOCITY  (VCE)  , 
AND  STEERING  VELOCITY  (VSE) 

DO  10  1=1,3 

DLV(I)  =  VTT(I)  -  VTTP'd) 

VGE(I)  =  VG(I)  -  DLV(I) 

VCE(I)  =  VGE(I)  +  VMIR(I) 

VSE(I)  =  VGE(I)  -  VDO(I) 

VTTP(I)  =  VTT(I) 

10  CONTINUE 

MVSE  =  SQRT  (  VSE(1)**2  +  VSE(2)**2  +  VSE(3)**2  ) 

MDVT  =  SQRT  (  DLV{1)**2  +  DLV(2)**2  +  DLV(3)**2  ) 

C  CALCULATE  POSITION  BIAS  SCALE  FACTOR 

IF  (  MVSE.GT.MVR  )  THEN 
SCALE 3  =  MVR/MVSE 
ELSE 

SCALE3  =1.0 
END  IF 

SCALAR  =  F2  *  MVR  *  SCALE3  /  (  FI  +  MDVT  ) 

C  CALCULATE  OFFSET  POSITION  VECTOR 

IF  {  T.GE.TSTG2  )  THEN 
RB(1)  =  RMIR(l) 

RB(2)  =  RMIR(2) 

RB(3)  =  RMIR(3) 

ELSE 

RBC)  =  RMIR(l)  +  SCALAR*VSE(1) 

RB(2)  =  RMIR(2)  +  SCALAR*VSE (2 ) 

RB(3)  =  RMIR(3)  +  SCALAR*VSE (3) 

END  IF 

DO  30  :  =  1, ILOOP 

C  COMPUTE  UNIT  VECTORS 

MRB  =  SQRT  (RB  (1)  **2  +  RB,(2)**2  +  RB(3)**2) 

URB ( 1 )  =  RB ( 1 ) /MRB 
URB(2)  =  KB(2)/MRB 
URB (5)  =  RB(3) /MRB 

MRT  =  SQRT (RTPRED (1) **2  +  RTPRED(2)**2  +  RTPRED (3) **2) 

URT(li  =  RTPRED (1) /MRT 
URT(2)  =  RTPRED (2) /MRT 


307 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


URT(3)  =  RTPREDO) /MRT 

TMPVd)  =  URB(2)  *URT(3)  -  URB  (3)  *URT  (2) 

TMPV(2)  =  URB(3) *URT(1)  -  URB (1) *URT (3) 

TMPV(3)  =  URB(l) *URT(2)  -  URB (2) *URT ( 1 ) 

MTMPV  =  SQRT{TMPV(1) **2  +  TMPV(2)**2  +  TMPV(3)**2) 
UTMPV(l)  =  TMPV(l) /MTMPV 
UTMPV(2)  =  TMPV(2) /MTMPV 
UTMPV(3)  =  TMPV(3) /MTMPV 

UTHP(l)  =  UTMPV(2) *URB (3)  -  UTMPV(3) *URB (2) 

UTHP(2)  =  UTMPV(3) *URB(1)  -  UTMPV(l) *URB (3) 

UTHP(3)  =  UTMPV(l) *URB(2)  -  UTMPV (2 ) *URB ( 1) 

C  ESTIMATE  HORIZONTAL  AND  RADIAL  COMPONENTS  OF  VC 

VHC  =  VCE (1) *UTHP (1)  +  VCE(2) *UTHP (2)  +  VCE (3) *UTHP ( 3) 

VCR  =  VCE(l) *URB(1)  +  VCE(2) *URB{2)  +  VCE (3) *URB (3) 

C  COMPUTE  SIN  AND  COS  OF  RANGE  ANGLE 

VPHI(l)  =  URB(2) *URT(3)  -  URB (3) *URT (2) 

VPHI(2)  =  URB(3) *URT{1)  -  URB (1) *URT (3) 

VPHI(3)  =  URB(l) *URT(2)  -  URB (2) *URT (1) 

SINPHI  =  SORT  (  VPHI(1)**2  +  VPHI(2)**2  +  VPHI(3)**2  ) 
COSPHI  =  URB(l) *URT(1)  +  URB (2) *URT (2)  +  URB{3)  'URT{3) 

C  COMPUTE  INTERMEDIATE  VARIABLES 

MVCE  =  SORT  (  VCE(1)**2  +  VCE(2)**2  +  VCE(3)**2  ) 

W  =  VHC  /  MRB 

EL  =  MRB  *  VHC* *2  /  GMU 

AR  =  MRB  /  MRT 

TPl  =  MVCE**2  *  MRB  /  GMU 

HHH  =  EL  *  SINPHI**2  *  (  2.0  -  TPl  ) 

SQRHHH  =-■  SORT  (  HHH  ) 

C  COMPUTE  TIME  OF  FLIGHT  ESTIMATE 

T1  =  EL  *  SINPHI  /  (  HHH  *  W  ) 

T2A  =(1.0-  EL)  /AR+1.0-  AR*EL 
T2B  =  (  2.0*EL  -  1.0  -  1.0/AR  )  *  COSPHI 
T2  =  T2A  +  T2B 

T3  =  2.0  *  EL**2  *  SINPHI**3  /  (  W  *  HHH  *  SQRHHH  ) 

T4A  =  SQRHHH 

T4B  =  EL  +  AR*EL  +  COSPHI  -  1.0 

T4  =  ATAN2(  T4A  ,  T4B  ) 

TFFE  =  T1*T2  +  T3*T4 

C  ESTIMATE  TOTAL  TIME  OF  FLIGHT 

TTFE  =  T  +  TFFE 

C  COMPUTE  TIME  OF  FREE  FALL  AND  TIME  OF  FLIGHT  ERROR 

TFF  =  TTF  -  T 

DELTF  -  TFF  -  TFFE 

C  COMPUTE  PARTIAL  OF  TFF  W/RESPECT  TO  VC 

A  =  2.0  *  (  AR  -  COSPHI  )  /  SINPHI  +  (  VCR  /  VHC  ) 


308 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


B  =  A^VCR  -  VKC 

C  =  B  *  MRB  /  GMU 

D  =  C  *  EL  *  SINPHI**2 

E  =  D  +  HHH/VHC 

PARHV  =  E  *  2.0 

PARTIV  =  (  1.0/VHC  -  PARHV/HHH  )  *  T1 

PART2V  =  (  2.0*EL/VHC  )  *  (  2.0*COSPHI  -  ( 1 . 0+AR* *2 ) /AR  ) 
PART3V  =  (  1.0/VHC  -  PARHV/ (2 . 0*HHH)  )  *  3.0  *  T3 

SUBEQl  =  (  EL  +  AR*EL  +  COSPHI  -  1.0  )  *  VHC  *  PARHV 

SUBEQ2  =  4.0  *  HHH  *  EL  '  (  1.0  +  AR  ) 

SUBEQ3  =  (  EL  +  AR*EL  +  COSPHI-1.0  ) **2  +  HHH 
SUBEQ4  =  2.0  *  SQRHHH  *  VHC 

PART4V  =  (  SUBEQl  -  SUBEQ2  )  /  (  SUBEQ3  *  SUBEQ4  ) 

PTFFV  =  T1*PART2V  +  T2*PART1V  +  T3*PART4V  +  T4*PART3V 

VCOPK  =  VHC  +  DCLTF/PTFFV 

C  COMPUTE  CORRELATED  VELOCITY  VECTOR 

C  HIT  EQUATION  FOR  RADIAL  COMPONENT  OF  VCP 

VCRPK  =  VCOPK/ (EL*SINPHI)  *  (  1.0  -  AR*EL  ~  ( 1 . 0-EL) *COSPHI  ) 

C  COMPUTE  VC,VG,VS 

DO  20  J  =  1  ,  3 

VC{J)  =  VCRPK*URB(J)  +  VCOPK*UTHP ( J) 

VG{J)  =  VC(J)  -  VMIR(J) 

VS(J)  =  VG(J)  -  VD0{J) 

20  CONTINUE 

30  CONTINUE 

MVS  =  SQRT(VS(1) **2  +  VS(2)**2  +  VS(3)**2) 

UVS(l)  =  VS (1) /MVS 
UVS(2)  =  VS (2) /MVS 
UVS(3)  =  VS (3) /MVS 

RETURN 

END 
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B.2.9  Uudnorm.for 


SUBROUTINE  NORM(SD, 

MN, ISEED, RDN) 

SUBROUTINE  NAME  : 

NORM 

AUTHOR (S)  ; 

D.  F.  SMITH 

FUNCTION  : 

GENERATES  NORMALLY  DISTRIBUTED  RANDOM 
NUMBERS  USING  THE  BOX-MULLER  TRANSFORMATION 

CALLED  FROM  : 

UTILITY  SUBROUTINE 

SUBROUTINES  CALLED 

:  RANG 

INPUTS  : 

SD,MN 

OUTPUTS  : 

RDN 

BOTH  : 

ISEED 

UPDATES  : 

D.  SMITH  -  CR  # 
R.  RHYNE  -  CR  # 

062 

087 

IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (0-Z) 

DOUBLE  PRECISION  MN 
INTEGER* 4  ISEED 

COMMON  /  NORCOM  /  GSET  ,  I SET 

DATA  ONE  /  l.ODO  / 

DATA  TWO  /  2.0D0  / 

IF  A  SPARE  RANDOM  NUMBER  IS  NOT  AVAILABLE  FROM  THE  PREVIOUS  PASS 
GENERATE  TWO  NEW  ONES 

IF  (  ISET.EQ.O  )  THEN 

GET  TWO  UNIFORM  RANDOM  NUMBERS  WITHIN  THE  SQUARE  EXTENDING 
FROM  -1  TO  1  IN  EACH  DIRECTION 

1  VI  =  TWO*RANO (ISEED)  -  ONE 

V2  =  TWO*RANO (ISEED)  -  ONE 

SEE  IF  THEY  ARE  WITHIN  THE  UNIT  CIRCLE  .  IF  NOT  ,  TRY  AGAIN  . 

R  =  V1*V1  +  V2*V2 

IF  (  R.GE.ONE  )  GO  TO  1 

PERFORM  BOX-MULLER  TRANSFORMATION  TO  GENERATE  TWO  GAUSSIA.J 
RANDOM  NUMBERS  .  RETURN  ONE  AND  SAVE  THE  OTHER  FOR  THE  NEXT 
PASS  . 

FAC  =  DSQRT  (  -TWO*DLOG (R) /R  ) 

GSET  =  FAC*V1 

RDN  =  MN  +  SD*FAC*V2 

ISET  =  1 
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C  USE  GAUSSIAN  RANDOM  NUMBER  CARRIED  OVER  FROM  PREVIOUS  PASS  . 

ELSE  IF  {  ISET.EQ.l  )  THEN 
RDN  =  MN  +  SD*GSET 

jlSET  =  0 

END  IF 

RETURN 

END 
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B.2.10  Uuestrel.for 

c - 

SUBROUTINE  ESTREL {TI2M, CMS, ESTATE, RREL, 

VREL, MAGR, MAGV, URREL, MGRDOT, TGO, PITER, YAWER, 
LAMD) 


SUBROUTINE  NAME  : 
AUTHOR  (S) 

FUNCTION  : 

CALLED  FROM  : 


ESTREL 
T.  THORNTON 

COMPUTES  ESTIMATED  RELATIVE  RANGE,  RANGE 
RATE,  AND  TIME-TO-GO 

FORTRAN  MAIN 


SUBROUTINES  CALLED  :  NONE 


INPUTS  : 


RREL, VREL, TI2M, CMS, ESTATE 


OUTPUTS 


MAGR, MAGV, URREL, MGRDOT, TGO, 
PITER, YAWER, LAMD 


UPDATES  : 


D. 

SMITH 

-  CR 

# 

059 

R. 

RHYNE 

-  CR 

# 

068 

D. 

SISSOM 

-  CR 

# 

069 

B. 

R. 

HILL  / 
RHYNE 

-  CR 

# 

081 

R. 

RHYNE 

-  CR 

# 

088 

R. 

RHYNE 

-  CR 

# 

093 

IMPLICIT  REAL  (A-H) 
IMPLICIT  REAL  (0-Z) 


REAL  CMS (9) 

,  LAMD (2) 

,  LAMSKE(2) 

REAL  MAGR 

,  MAGV 

,  MGRDOT 

REAL  RELM(3) 

,  RELS(3) 

REAL  RREL (3) 

,  TI2M(9) 

REAL  URREL (3) 

,  VELM(3) 

,  VELS(3) 

REAL  VMIR(3) 

,  VREL(3) 

,  VTEST(3) 

DOUBLE  PRECISION 

RTEST (3) 

DOUBLE  PRECISION 

RMIR(3) 

INTEGER 

ESTATE 

C  COMPUTE  ESTIMATED  RELATIVE  STATES  AND  ESTIMATED  TIME-TO-GO 

MAGR  =  SORT  (RREL  (1)  **2  +  RREL(2)**2  +  RREL  (3) ''*2) 

URREL (1)  =  RREL (1) /MAGR 
URREL (2)  =  RREL (2) /MAGR 
URREL (3)  =  RREL (3) /MAGR 

MAGV  =  SORT (VREL ( 1) **2  +  VREL(2)**2  +  VREL(3)**2) 

MGRDOT  =  VREL(l) *URREL(1)  +  VREL (2) *URREL (2)  +  VREL (3) *URREL (3) 
VRDRR  =  VREL(i) *RREL(1)  +  VREL (2 ) *RREL (2 )  +  VREL (3) *RREL (3) 
TGO  =  -VRDRR/ (MAGV* *2) 

IF  (  ESTATE. EQ.l  )  THEN 

C  COMPUTE  ESTIMATED  RELATIVE  STATES  MISSILE  FRAME 
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RELM(l)  =  RREL(l)  *TI2M<1)  +  RREL  (2)  *TI2M  (4)  +  RREL  (3)  *TI2M  {'’ ) 

RELM(2)  =  RREL(l) *TI2M(2)  +  RREL (2 ) *TI2M (5)  +  RREL (3) *TI2M ( 8) 

RELM(3)  =  RREL(l) *TI2M(3)  +  RREL (2) *TI2M ( 6)  +  RREL (3) *TI2M(9) 

VELM(l)  =  VREL(l) *TI2M(1)  +  VREL (2 ) *TI2M ( 4 )  +  VREL (3) *TI2M (7) 

VELM(2)  =  VREL(l) *TI2M(2)  +  VREL (2) *TI2M (5)  +  VREL (3) *TI2M ( 8) 

VELM(3)  =  VREL(l) *TI2M{3)  +  VREL (2) *TI2M ( 6)  +  VREL (3) *TI2M ( 9) 

C  COMPUTE  ESTIMATED  RELATIVE  STATES  IN  SEEKER  FRAME 

RELSd)  =  RELM(l)  *CMS  (1)  +  RELM(2)  *CMS  (4)  +  RELM (3)  *CMS  (7) 

RELS{2)  =  RELM(l) *CMS (2)  +  RELM (2 ) *CMS ( 5)  +  RELM (3) *CMS (8) 

RELS(3)  =  RELM(l) *CMS (3)  +  RELM (2) “CMS (6)  +  RELM ( 3 ) *CMS ( 9) 

VELS(l)  =  VELM(1)*CMS(1)  +  VELM(2) *CMS (4)  +  VELM(3) *CMS  (7) 

VELS(2)  =  VELM(l) *CMS(2)  +  VELM(2) *CMS (5)  +  VELM (3) *CMS (8) 

VELS(3)  =  VELM(l) *CMS(3)  +  VELM (2 ) *CMS ( 6)  +  VELM (3) *CMS (9) 

C  COMPUTE  ESTIMATED  LINE  OF  SIGHT  ERRORS 

LAMSKEd)  =  ATAN2  (-RELS  (3)  ,RELS  (1)  ) 

LAMSKE(2)  =  ATAN2(  RELS (2) , RELS (1) ) 

PITER  =  LAMSKEd) 

YAWER  =  -LAMSKE(2) 

C  COMPUTE  ESTIMATED  LINE  OF  SIGHT  RATE  ERRORS 

LAMDd)  =  {RELS(3)  *VELSd)  -  RELS  (1)  *VELS  (3)  )  / 

(RELSd)**2  +  RELS(3)**2) 

LAMD(2)  =  (RELSd)  *VELS{2)  -  RELS  (2)  *VELS  (1)  )  / 

(RELSd)**2  +  RELS(2)**2) 

ENDIF 

RETURN 

END 
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B.2.1iUuestrl2.for 

1^  — —  — —  —  —  —  —  —  —  —  — —  —  —  —  — —  —  — - 

SUBROUTINE  ESTREL2 (RTEST, VTEST, RMIR, VJIIR, RREL, VREL) 


SUBROUTINE  NAME  :  ESTREL2 


AUTHOR (S) 


T.  THORNTON 


JUNCTION 


COMPUTES  ESTIMATED  RELATIVE  RANGE,  RANGE 
RATE,  AND  TIME-TO-GO 


c-ALLED  FROM  : 


FORTRAN  MAIN 


SUBROUTINES  CALLED  :  NONE 


INPUTS  :  RTEST,VTEST,RMIR,  VMIR 

C'UTPUTS  :  RREL,  VREL 


UPDATES 


D. 

SMITH 

-  CR 

# 

059 

R. 

RHYNE 

-  CR 

# 

068 

D. 

SISSOM 

-  CR 

# 

069 

B., 

R. 

HILL  / 
RHYNE 

-  CR 

# 

081 

R. 

RHYNE 

-  CR 

# 

088 

R. 

RHYNE 

-  CR 

# 

093 

IMPLICIT  DOUBLE  PREIISION  (A-H) 
IMPLICIT  DOUBLE  PRECISION  (0-2) 


DOUBLE  PRECISION  RREL (3) 
DOUBLE  PRECISION  VMIR (3) 
.-•UBLE  PRECISION  RTEST  (3) 
DOUBLE  PRECISION  RMIR (3) 


VREL (3) 


VTEST  (3) 


C  COMPUTE  ESTIMATED  RELATIVE  STATES  AND  ESTIMATED  TIME-TO-GO 


RREL(l) 

=  RTEST (1) 

-  RMIR(l) 

RREL (2) 

=  RTEST  2' 

-  P^IR(2) 

RREL (3) 

=  RTEST (3) 

-  i-jIIR<3) 

VREL(l) 

=  VTEST  (1) 

-  VMIR(l) 

VREL (2) 

=  VTEST (2) 

-  VMIR(2) 

VREL (3) 

=  VTEST (3) 

-  VMIR(3) 

RETURN 

END 
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B.2.12  Uufv2oyi,for 

c -  - 

SUBROUTINE  FV2BXI  (  FV,  FVSQ,  B  ) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 
FUNCTION  : 


CALLED  FROM  : 
SUBROUTINES  CALLED  : 
INPUTS  ; 

OUTPUTS  : 

UPDATES  : 


iV2BXI 
W.  E.  EXELY 

COMPUTE  DIRECTION  COSINE  MATRIX  (B)  FROM 
THE  QUATERNION  ATTITUDE  VECTOR  (FV)  AND 
COMPUTE  THE  SQUARE  (FVSQ)  OF  THE  MAGNITUDE 
OF  THE  QUATERNION  (FV) 

MISSIL 

NONE 

FV 

FVSQ, B 

D..  SMITH  -  CR  #  59 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

C 

DIMENSION  FV  (  4  ) ,  B  (  9  ) 

C 

DATA  Rl,  R2  /  1.0,  2.0  / 

C 

FI  =  FV(1) 

F2  =  FV(2) 

F3  =  FV(3) 

F4  =  FV(4) 

FIS  =  F1*F1 
F2S  =  F2*F2 
F3S  =  F3*F3 
F4S  =  F4*F4 

TT  =  FIS  +  F2S  +  F3S  F4S 
C 

IF(  TT  )  20,  20,  10 
C 

10  CONTINUE 
C 


T1 

= 

R2/TT 

T2 

= 

F3*F4 

T3 

= 

F1*F2 

B(2) 

= 

Tl*(  T3 

+ 

T2 

) 

B(4) 

ss 

Tl*(  T3 

- 

T2 

) 

T2 

= 

F2*F4 

T3 

= 

F1*F3 

B(7) 

= 

Tl*(  T3 

+ 

T2 

) 

B(3) 

= 

Tl*(  T3 

- 

T2 

) 

T2 

= 

F1*F4 

T3 

= 

F2*F3 

B(6) 

= 

Tl*(  T3 

T2 

) 

B(8) 

Tl*(  T3 

- 

T2 

) 
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C 

C 

C 

C 


T2  =  T1*F4S  -  R1 

B(l)  =  T1*F1S  +  T2 

B(5)  -  T1*F2S  +  T2 

B(9)  =  T1*F3S  +  T2 

20  CONTIKUS 

FVSQ  =  TT 

RETURN 

END 
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B.2.13  Uufvdot.for 


SUBROUTINE  FVDOT  (  W, 

WD,  F,  FD  ) 

SUBROUTINE  NAME  : 

FVDOT 

AUTHOR (S)  : 

W.  E.  EXELY 

FUNCTION  : 

COMPUTE  THE  QUATERNION  DERIVATIVES  (FD) 
USING  BODY  RATES  (W)  AND  LATENT  INTEGRAL 
DERIVATIVE  (WD)  AND  THE  QUATERNION  (F) 

CALLED  FROM  : 

FORTRAN  MAIN,  MISSIL 

SUBROUTINES  CALLED  : 

NONE 

INPUTS  : 

W,WD,F 

OUTPUTS  ; 

FD 

UPDATES  : 

D..  SMITH  -  CR  #  59 

IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

C 

DIMENSION  W( 3),  F(4),  FD{4) 
C 

W1  =  W(l) 

W2  =  W(2) 

W3  =  W(3) 

W4  =  WD 
FI  =  F(l) 

F2  =  F(2) 

F3  =  F(3) 

F4  =  F(4) 

C 


FD(1) 

=  ( 

W4*F1 

+ 

W1*F4 

- 

W2*F3 

+ 

W3*F2 

) 

*0.5 

FD(2) 

=  ( 

W4*F2 

+ 

W1*F3 

+ 

W2*F4 

- 

W3*F1 

) 

*0.5 

FD(3) 

=  ( 

W4*F3 

- 

W1  *F2 

+ 

W2*F1 

+ 

W3*F4 

) 

*0.5 

FD(4) 

=  ( 

W4*F4 

- 

W1*F1 

- 

W2*F2 

- 

W3*F3 

) 

*0.5 

C 

RETURN 

END 
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B.2.14  Uugyro.for 

c - 

SUBROUTINE  GYRO (T, P, Q, R, CIM, GYSEED, QFRACG, PULSEG) 


SUBROUTINE  NAME  :  GYRO 


AUTHOR (S)  :  A.  P.  BUKLEY,  M.  K.  DOUBLEDAY 

FUNCTION  :  GYRO  MODEL  COMPUTES  SENSED  DELTA  ANGLE 

COUNTS.  INCLUDES  AXIS  MISALIGNMENT  AND 
NONORTHOGONALITY  ERRORS,  SCALE  FACTOR 
ERRORS, RANDOM  AND  CONSTANT  DRIFT,  AND 
QUANTIZATION. 


CALLED  FROM  : 
SUBROUTINES  CALLED  ; 
INPUTS  : 

OUTPUTS  : 

BOTH  : 

UPDATES  : 


FORTRAN  MAIN 
NORM, BRTAVG, RESP2P 
T,P,Q,R,CIM 
NONE 


GYSEED, QFRACG, PULSEG 


T. 

THORNTON 

- 

CR 

# 

004 

T. 

THORNTON 

- 

CR 

# 

016 

B. 

HILL 

- 

CR 

# 

020 

D 

SMITH 

- 

CR 

# 

021 

B., 

HILL 

- 

CR 

# 

022 

B. 

HILL 

- 

CR 

# 

030 

B. 

HILL 

- 

CR 

# 

038 

D. 

SMITH 

- 

CR 

# 

059 

D. 

SISSOM 

- 

CR 

# 

069 

D. 

SMITH 

- 

CR 

# 

070 

D. 

SMITH 

- 

CR 

# 

075 

D. 

SMITH 

- 

CR 

# 

077 

D. 

SMITH 

- 

CR 

# 

078 

B. 

HILL  / 

- 

CR 

# 

081 

R. 

RHYNE 

R. 

RHYNE 

- 

CR 

# 

083 

R. 

RHYNE 

- 

CR 

# 

084 

R. 

RHYNE 

- 

CR 

# 

087 

B. 

HILL 

- 

CR 

# 

093 

IMPLICIT  DOUBLE  1 
IMPLICIT  DOUBLE  1 

PRECISION 

PRECISION 

(A-H) 

(0-Z) 

DOUBLE 

PRECISION 

CIM{9) 

/ 

CIMO(9) 

,  DCG(3) 

DOUBLE 

PRECISION 

DTHET(3) 

/ 

PULSEG (3) 

,  PQRAVG(3) 

DOUBLE 

PRECISION 

QFRACG (3) 

r 

SF1G(3) 

,  SF2G(3) 

DOUBLE 

PRECISION 

SFEG(3) 

r 

WBI0(3) 

DOUBLE 

PRECISION 

WBIl (3) 

f 

WBI2 (3) 

,  WBOO(3) 

DOUBLE  PRECISION 

INTEGER* 4 

WBOl (3) 

GYSEED 

t 

WB02 (3) 

,  WDRG(3) 

LOCAL  COMMON  USED  FOR  CONSTANTS,  LOCAL  VARIABLES  AND 
INITIALIZATION  FLAG 
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SAVE  IGYRO 

C  COMMON  "RGYRO"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RGYRO  /  PSIG  ,  THTG  ,  PHIG  ,  THXZG  ,  THXYG  , 

THYZG  ,  THYXG  ,  THZYG  ,  THZXG  ,  SFIG  , 

SF2G  ,  DCG  ,  TOGYRO  ,  '’IMO  ,  KBIZ  , 

WBIl  ,  WB02  ,  WBOl  ,  DRSIGG 

*  DATA  INITIALIZATION 

SINCLUDE ( ' ^/include/ssdataSS .dat ' ) 

SINCLUDE  ( '  ''/include/ssdataie  .dat ' ) 

SINCLUDE  ( '  ''/include/ssdataZl  .dat ' ) 

DATA  IGYRO  /  1  / 

IF  (IGYRO  .EQ.  1)  THEN 
IGYRO  =  0 

C  INITIALIZE  GYRO  PARAMETERS 

IF  (T  .EQ.  0.0)  THEN 

DRSIGG  =  DRSGGI/ (60.0*DSQRT(DTIMU) *DTR) 

CALL  NORM (ALNSGG, ALNMNG, GYSEED, PSIG) 

CALL  NORM (ALNSGG, ALNMNG, GYSEED, THTG) 

CALL  NORM (ALNSGG, ALNMNG, GYSEED, PHIG) 

CALL  NORM (AORSGG, AORMNG, GYSEED, THXZG) 

CALL  NORM (AORSGG, AORMNG, GYSEED, THXYG) 

CALL  NORM (AORSGG, AORMNG, GYSEED, THYZG) 

CALL  NORM (AORSGG, AORMNG, GYSEED, THYXG) 

CALL  NORM (AORSGG, AORMNG, GYSEED, THZYG) 

CALL  NORM (AORSGG, AORMNG, GYSEED, THZXG) 

CALL  N0RM(SF1SGG, SFIMNG, GYSEED, SFIG (1) ) 

CALL  NORM (SFISGG, SFIMNG, GYSEED, SFIG (2) ) 

CALL  N0RM(SF1SGG, SFIMNG, GYSEED, SFIG (3) ) 

CALL  NORM  ;F2SGG, SF2MNG, GYSEED, SF2G (1) ) 

CALL  NORM  >,,F2SGG,SF2MNG,  GYSEED,  SF2G  (2)  ) 

CALL  NORM(SF2SGG,SF2MNG,GYSEED,SF2G(3) ) 

CALL  NORM (DCSIGG,DCMENG, GYSEED, DCG (1) ) 

C;LL  norm (DCSIGG,DCMENG, GYSEED, DCG (2) ) 

CALL  NORM(DCSIGG,DCMENG,GYSEED,DCG(3) ) 

DO  10  I  =  1,3 

WBI2 (I)  =  O.ODO 
WBIl(I)  =  O.ODO 
WB02  (I)  =  O.ODO 
WBOl (I)  =  O.ODO 
10  CONTINUE 

END  IF 

C  COMPUTE  SECOND  ORDER  RESPONSE  DIFFERENCE  EQUATION  COEFFICIENTS 
IF  (  IGRTYP.EQ.2  )  THEN 

CALL  RESP2R  (  DTIMU, WGYR, ZGYR, CWBI2, CWBIl, CWBIO, CWB02 , CWBOl, 
CWBOO  ) 

END  IF 
END  IF 

C  COMPUTE  DELTA  TIME  SINCE  LAST  PASS  THROUGH  GYRO 

DTDEL  =  T  -  TOGYRO 
TOGYRO  =  T 
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C  DETERMINE  AVERAGE  BODY  RATE  OVER  LAST  INTERVAL 

IF  (  DTDEL.NE.O.ODO  )  THEN 

CALL  BRTAVG  (  CIM  ,  CIMO  ,  DTDEL  ,  PQRAVG  ) 

;  '  SE 

PQRAVG (1)  =  P 
PQRAVG (2)  =  Q 
P„RAVG(3)  =  R 
END  IF 

C  SAV",  liJERTIAL-TO-MISSILE  ROTATION  MATRIX  FOR  NEXT  PASS 

DO  ?■)  I  =  1  ,  9 
CIMO(I)  =  CIM(I) 

20  CONTINUE 

C  GYRO  AXIS  MISALIGNMENT  EFFECTS 

PM  «  PQRAVGd)  +  PQRAVG  (2)  *PSIG  -  PQRAVG  (3)  *THTG 

QM  =  PQRAVG{2)  -  PQRAVG (1) *PSIG  +  PQRAVG ( 3 ) *PHIG 

RM  =  PQRAVGO)  +  PQRAVG (1)  *THTG  -  PQRAVG  (2 )  *PHIG 

C  GYRO  AXIS  NONORTHOGONALITY  EFFECTS 

PN  =  PM  +  QM*THXZG  -  RM»THXYG 

QN  =  QM  -  PM*THYZG  +  RM*THYXG 

RN  =  RM  +  PM*THZYG  -  QM*TH2XG 

C  ADD  LINEAR  AND  QUADRATIC  SCALE  FACTOR  ERRORS 

SFEG(l)  =  PN  +  SF1G(1)*PN  +  SF2G (1) *PN**2 
SFEG(2)  =-  QN  +  SF1G(2)*QN  +  SF2G (2)  *QN**2 
SFEG{3)  =  RN  +  SF1G(3)*RN  +  SF2G (3) *RN**2 

C  FOR  EACH  AXIS  . . . 

DO  30  I  =  1,3 

C  MAKE  A  GAUSSIAN  DRAW  FOR  RANDOM  DRIFT  AND  ADD  TO  CONSTANT 

C  DRIFT 

IF  I  DRSIGG.GT.O.ODO  )  THEN 

CALL  NORM (DRSIGG, DRMENG, GYSEED, DRG) 

ENDIF 

WDRG(I)  =  DRG  +  DCG(I) 

C  COMPUTE  INPUT  TO  GYRO  RESPONSE  MODEL 

WBIO(I)  =  SFEG(I)  +  WDRG(I) 

C  SECOND  ORDER  RESPONSE  MODEL 

IF  (  IGRTYP.EQ.2  )  THEN 

WBOO(I)  =  (  CWBI0*WBI0(I)  +  CWBI1*WBI1 (I) 

+  CWBI2*WBI2 (I)  -  CWB01*WB01 (I) 

-  CWB02*WB02 (I)  )/CWBOO 
WBI2 (I)  =  WBIl (I) 

WBIl  (I)  =  WBIO  (I) 

WB02 (I)  =  WBOl (I) 

WBOl(I)  =  WBOOd) 

ENDIF 


320 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


C  INSTANTANEOUS  RESPONSE  MODEL 

IF  (  IGRTYP.EQ.O  )  THEN 
WBOO  (I)  =  WBIO  (I) 

ENDIF 

C  COMPUTE  DELTA  THETA 

DTHET(I)  =  DTDEL  *  WBOO { I) 

IF  {  SPPG.GT.0.0  )  THEN 

C  UNQUANTIZED  OUTPUT  IN  COUNTS 

QFRACG(I)  =  QFRACG(I)  -  PULSEGd)  +  DTHET  (I) /SPPG 

C  QUANTIZED  OUTPUT  IN  COUNTS 

PULSEGd)  =  DINT  (QFRACGd)  ) 

ELSE 

PULSEGd)  =  DTHET  (I) 

ENDIF 

30  CONTINUE 

RETURN 

END 
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B.2.15  Uuimupro.for 

c - 

SUBROUTINE  IMUPRO (T, PULSEG, PULSEA, DELPHI, DELTHT, DELPSI, DELU, 
DELV, DELW) 


SUBROUTINE  NAME  :  IMUPRO 

AUTHOR (S)  :  T.  THORNTON 

FUNCTION  :  COMPUTES  THE  IMU  PROCESSOR  RELATED  FUNCTIONS 

CALLED  FROM  :  FORTRAN  MAIN 

SUBROUTINES  CALLED  :  NONE 

INPUTS  :  T, PULSEG, PULSEA 

OUTPUTS  :  DELPHI, DELTHT, DEIFSI, DELU, DELV, DELW 

UPDATES  :  T.  THORNTON  -  CR  #  004 

T.  THORNTON  -  CR  #  016 

B.  HILL  -  CR  #  022 

T,  THORNTON  -  CR  #  037 

D.  SMITH  -  CR  #  059 

D.  SMITH  -  CR  #  070 

D.  SMITH  -  CR  #  075 

B.  KILL  /  -  CR  #  081 

R,  RHYNE 

B.  HILL  -  CR  #  093 


IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (0-Z) 

DOUBLE  PRECISION  PULSEA (3)  ,  PULSEG (3) 

*  DATA  INITIALIZATION 

SINCLUDE ( ' ^/INCLUDE/SSDATA54 .DAT ' ) 

C  GYRO  OUTPUT  COMPENSATION 

C  CALCULATE  DELTA  ANGLES 

IF  (  PERPG.GT.0.0  )  THEN 
DELPHS  =  PULSEG (1) *PERPG 
DELTHS  =  PULSEG (2) *PERPG 
DELPSS  =  PULSEG (3) *PERPG 
ELSE 

DELPHS  =  PULSEG (1) 

DELTHS  =  PULSEG (2) 

DELPSS  =  PULSEG (3) 

END  IF 

C  COMPENSATE  SENSED  DELTA  ANGLES  FOR  SCALE  FACTOR  ERRORS 

DELPH  =  DELPHS*SFCGX 
DELTH  =  DELTHS*SFCGY 
DELPS  =  DELPSS*SFCGZ 

C  COMPENSATE  SENSED  DELTA  ANGLES  FOR  GYRO  MISALIGNMENTS 
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DELPHI  =  DELPH  -  DELTH*PSIGP  +  DELPS*THTGP 

DELTHT  =  DELPH*PSIGP  +  DELTH  -  DELPS*PHIGP 

DELPSI  =  -DELPH*THTGP  +  DELTH*PHIGP  +  DELPS 

C  ACCELEROMETER  OUTPUT  COMPENSATION 

C  CALCULATE  DELTA  VELOCITY 

IF  (  PERPA.GT.0.0  )  THEN 
DELUS  =  PULSEA(l) *PERPA 
DELVS  =  PULSEA{2) *PERPA 
DELWS  =  PULSEAO)  *PERPA 
ELSE 

DELUS  =  PULSEA(l) 

DELVS  -  PUL?EA(2) 

DELWS  =  PULSEAO) 

END  IF 

C  COMPENSATE  SENSED  VELOCITY  FOR  SCALE  FACTOR  ERRORS 

DELXS  =  DELUS *SFCAX 
DELYS  =  DELVS *SFCAY 
DELZS  =•  DELWS*SFCAZ 

C  COMPENSATE  SENSED  VELOCITY  FOR  ACCELEROMETER  MISALIGNMENTS 

DELUM  =  DELXS  -  DELYS*PSIAP  +  DEL2S*THTAP 

DELVM  =  DELXS*PSIAP  +  DELYS  -  DELZS*PHIAP 

DELWM  =  -DELXS*THTAP  +  DELYS*PHIAP  +  DELZS 

C  SKULLING  COMPENSATION 

IF  (  ISKULL.EQ.O  )  THEN 
DELU  =  DELUM 
DELV  =  DELVM 
DELW  =  DELWM 
ELSE 

DELU  =  DELUM  -  0.5  *  (  DELPSI*DELVM  -  DELTHT*DELWM  ) 

DELV  =  DELVM  -  0.5  *  (  DELPHI*DELWM  -  DELPSI *DELUM  ) 

DELW  =  DELWM  -  0.5  *  (  DE -THT*DELUM  -  DELPHI*DELVM  ) 

END  IF 

RETURN 

END 
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B.2.16  Uuinteg.for 

c - 

SUBROUTINE  INTEG  (  X  ,  XDOT  ,  T  ,  I  ) 


SUBROUTINE  NAME  :  INTEG 


AUTHOR (S)  : 


D.  F.  SMITH 


FUNCTION  ;  Perform  simple  trapezoidal  integration  of 

XDOT  to  yield  X.  DTD  is  the  time  since 
the  last  integration  and  I  is  the  array 
index  where  X  is  stored 


CALLED  FROM  : 
SUBROUTINES  CALLED 
INPUTS  : 

OUTPUTS  : 

UPDATES  : 


FORTRAN  tiAIN 
NONE 
XDOT, T, I 
X 

D.  SISSOM  -  CR  #  58 
D.  SMITH  -  CR  #  59 


COMMON/STORAG/ 

XINT, 

TINT, 

XDOTL 

DOUBLE  PRECISION 

XINT(50) , 

TINT(50) , 

XDOTL(50) 

DOUBLE  PRECISION 

DT, 

DTMP, 

X 

DOUBLE  PRECISION 

XDOT, 

T 

DT  =  T  -  TINT (I) 


XINT(I)  =  XINT(I)  +  0.5DO*DT*^(XDOT+XDOTL(I)  ) 

X  =  XINT(I) 

TINT  (I)  =  T 

XDOTL(I)  =  XDOT 

C  TEMPORARY  CODE  TO  NORMALIZE  QUATERNION  AFTER  4TH  COMPONENT  IS 
REVISED 


IF 


(  I.EQ, 
DTMP 


18 


)  THEN 
DSQRT  ( 


XINT(15) 
XINT(16) 
XINT(17) 
XINT(18) 
END  IF 


XINTdS)  **2 
XINT(18) **2 


XINT(15) 

XINT(16) 

XINT(17) 

XINT(18) 


DTMP 

DTMP 

DTMP 

DTMP 


+  XINT(16)**2  +  XINT(17)**2 

) 


+ 


RETURN 

END 
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B.2.17  Uuintegi.for 

c - 

SUBROUTINE  INTEGI  (  X  ,  XDOT  ,  T  ,  I  ) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 
FUNCTION  : 


INTEGI 
D.  F,  SMITH 

Initialize  integral  of  X  which  is  stored 
in  position  I  of  the  integral  array 


CALLED  FROM  : 
SUBROUTINES  CALLED  : 
INPUTS  : 

OUTPUTS  : 

UPDATES  : 


MAIN 

NONE 


X,XDOT,T, I 
NONE 

D.  SISSOM  -  CR  #  58 
D.  SMITH  -  CR  #  59 


COMMON/ STORAG/ 

XINT, 

TINT, 

XDOTL 

DOUBLE  PRECISION 

XINT(50) , 

TINT (50) , 

XDOTL(50) 

DOUBLE  PRECISION 

X, 

T, 

XDOT 

XINT(I)  =  X 
XDOTLd)  =  XDOT 
TINT(I)  =  T 

RETURN 

END 
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B.2.18  Uukalman.for 

c - 

SUBROUTINE  KALMAN (T, TI2M, LAMMO, ASIG, SNRO, TGO, RRELO, VRELO, TI2MO, 

RACQ, MAGRTR,MAGR, MAGV, LAMSEK, LAMDXX, FRMRAT, CMS, 
MACQ,MCSO,MTERM, IRESLV, TRACK, TERM, TRMTGO, TGEl, 
TGE2AL, WFILT, ZFILT, LAM, LAMD, IBURNl , ACQD, ESTATE, 
PITER, YAWER, ROLLER) 


SUBROUTINE  NAME  :  KALMAN 

AUTHOR (S)  :  D.  F.  SMITH 

FUNCTION  :  2 -STATE  EXTENDED  KALMAN  FILTER 

ESTIMATES  LOS  ANGLES  AND  RATES 

CALLED  FROM  :  FORTRAN  MAIN 

SUBROUTINES  CALLED  :  NONE 

INPUTS  :  T,TI2M, LAMMO, ASIG, SNRO, TGO, RRELO, VRELO, 

TI2MO, RACQ, MAGRTR, MAGR, MAGV, LAMSEK, LAMDXX, 
FRMRAT, CMS, MACQ,MCSO,MTERM, IRESLV 

OUTPUTS  :  TRMTGO,TGEl,TGE2AL, WFILT, ZFILT, LAM, 

LAMD, IBURNl, ACQD, PITER, YAWER 

BOTH  :  ESTATE, TRACK, TERM 

UPDATES  :  D.  SISSOM  -  CR  #  032 

B.  HILL  -  CR  #  030 

B.  HILL  -  CR  #  038 

T,  THORNTON  -  CR  #  043 

T.  THORNTON  -  CR  #  048 

D.  SMITH  -  CR  #  059 

D.  SMITH  -  CR  #  064 

R.  RHYNE  -  CR  #  068 

D.  SISSOM  -  CR  #  069 

D.  SMITH  -  CR  #  070 

D.  SMITH  -  CR  #  074 

R.  RHYNE  -  CR  #  079 

B.  HILL  /  -  CR  #  081 

R.  RHYNE 

B.  HILL  -  CR  #  086 

R.  RHYNE  -  CR  #  087 

R.  RHYNE  -  CR  #  088 

D.  SISSOM  -  CR  #  091 

B.  HILL  -  CR  #  093 


IMPLICIT  REAL 

IMPLICIT  REAL 

CHARACTER* 12 8  MESSAGE 

(A-H) 

<0-Z) 

REAL 

CSSHFT(3) 

t 

TMSHFT(3) 

t 

TKSHFT(3) 

REAL 

LAMSEK  (2) 

t 

LAMDXX (2) 

r 

MAGRSQ 

REAL 

LAM (2) 

f 

LAI4D(2) 

t 

MAGRO 

REAL 

RRELO (3) 

/ 

VRELO (3) 

t 

RATE (6) 

REAL 

LAMMO (2) 

/ 

TI2MO(9) 

r 

TI2M(9) 

REAL 

REAL 

MAGR 

CMS (9) 

t 

MAGV 

f 

MAGRTR 
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INTEGER  SEKTYP  ,  ACQD 

INTEGER  ESTATE  ,  TRACK  ,  TERM 

C  LOCAL  COMMON  USED  FOR  CONSTANTS,  LOCAL  VARIABLES  AND 
C  INITIALIZATION  FLAG 

SAVE  IKALMN 

C  COMMON  "RKALMN"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RKALMN  /  TKF  ,  IDRTOK  ,  PPll  ,  PP12  ,  PP22  , 

PYll  ,  PY12  ,  PY22  ,  PLMDFP  ,  YLMDFP  , 

PLAMH  ,  YLAMH  ,  PLAMDH  ,  YLAMDH  ,  PLAMDF  , 

YLAMDF  ,  TGIL  ,  KFMODE  ,  IFPAS 

*  DATA  INITIALIZATION 

$INCLUDE(  ’''/INCLUDE/SSDATA48  .DAT') 

$  INCLUDE  ( '  /  INCLUDE /SSDATA50  .DAT ' ) 

SINCLUDE  ( '  ''/INCLUDE/SSDATA55  .DAT ' ) 

$  INCLUDE  ( ' INCLUDE /SSDATA5  6  .DAT' ) 

$  INCLUDE  (  '  -'/ INCLUDE /SSDATA5  7  .DAT  ' ) 

$  INCLUDE  ( ' INCLUDE /SSDATAll  .DAT' ) 

$INCLUDE  ( '  ''/INCLUDE/SSDATA12  .DAT ' ) 

DATA  IKALMN  /  1  / 

IF  (IKALMN  .EQ.  1)  THEN 

IKALMN  =  0 

IF  (IFPAS  .EQ.  0)  THEN 

C  INITIALIZE  FILTER  PARAMETERS 

KFMODE  =  1 

TKF  =  T 

C  INITIALIZE  FILTER  ESTIMATES  OF  INERTIAL  FRAME  LAMBDA  AND 

C  LAMBDA  DOT 

PLMDHl  =  (RRELOO)  *VRELO(l)  -  RRELO  ( 1 )  ^VRELO  ( 3 )  )  / 
(RRELO(l)**2  +  RRELOO)  **2) 

PLAMDH  =  PLMDHl 

YLMDHl  =  (RRELOd)  *VRELO(2)  -  RRELO  (2)  *VRELO  (1)  )  / 
(RRELO(l)**2  +  RRELO(2)**2) 

YLAMDH  =  YLMDHl 

C  INITIALIZE  COVAMANCE  MATRIX  ELEMENTS 

PP22  =  SGP22**2 

PY22  =  SGP22**2 

PP12  =  SGP12**2 

PY12  =  SGP12**2 

PPll  =  SGP11**2 

PYll  =  SGP11**2 

C  INITIALIZE  PROCESS  NOISE  COVARIANCE 

RW  =  SGW**2 

C  INITIALIZE  MEASUREMENT  NOISE  MATRIX 

RV  =  AKSGME*ASIG**2 
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END  IF 
END  IF 

C  INCREMENT  FILTER  PASS  COUNTER 

IFPAS  =  IFPAS  +  1 

C  PERFORM  EXECUTIVE  FUNCTION  FOR  SEEKER  TYPES  0  AND  1 

IF  (  SEKTYP.EQ.O  .OR.  SEKTYP.EQ.l  )  THEN 

C  INITIATE  ACQUISTION  MODE 

IF  (  ACQD.EQ.O  .AND.  MAGRTR . LE . RACQ  )  THEN 
ESTATE  =  0 

ACQD  =  1 

TRMTGO  =  TGO  -  (MAGR  -  RNGTRM) /MAGV 
TGIL  =  TRMTGO  +  TBWAIT 

TGE2AL  =  TGIL  +  DTVCS2 

CALL  OUTMESC  INITIATE  ACQUISITION  PHASE') 

END  IF 

C  COMPUTE  THE  SEEKER  DATA  RATE 

IF  {  TRACK  .EQ.  1  )  THEN 
TRACK  =  2 

TGEl  =  TGO  -  (RNHITS  +  ILAG) /FRMRAT 
IBURNl  =  0 

CALL  OUTMESC  INITIATE  TRACK  PHASE') 

ELSEIF  (  TERM  .EQ.  1  )  THEN 
TERM  =  2 

CALL  OUTMESC  INITIATE  TERMINAL  PHASE') 

ENDIF 


END  IF 

C  USE  TRUE  LOS  ANGLES  AND  RATES  WITH  PERFECT  SEEKER  MODEL 

IF  (  SEKTYP.EQ.O  .AND.  ESTATE. EQ.O)  THEN 
LAMD(l)  =  LAMDXX(l) 

LAMD(2)  =  LAMDXX(2) 

PITER  =  LAMMO(l) 

YAWER  =  LAMMO{2) 

ROLLER  =0.0 
RETURN 
ENDIF 


C  DETERMINE  APPARENT  RELATIVE  INERTIAL  FRAME  STATES  FOR  LOCAL  USE 


RXI  =  RRELO(l) 

RYI  =  RRELO(2) 

RZI  =  RRELOO) 

VXI  =  VRELO(l) 

VYI  =  VRELO{2) 

VZI  =  VRELOO) 


MAGRO 


SQKT  (  KXI**2  +  RYI* *2  +  RZI* *2  ) 


C  RECONSTRUCT  MEASURED  LOS  VECTOR  IN  SEEKER  FRAt4E 


TANPCH  =  TAN  (  LAMM0{1)  ) 
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TANYAW  =  TAN  (  LAMMO(2)  ) 

XLOSS  =  l.OEO  /  SORT  (  l.ODO  +  TANPCH’'*2  +  TANYAW* *2  ) 
YLOSS  =  XLGSS  *  TANYAW 
ZLOSS  =  -  XLOSS  *  TANPCH 


C  ROTATE  MEASURED  LOS  VECTOR  INTO  MISSILE  FRAME 

XLOSM  =  CMS(l)*XLOSS  +  CMS(2)*YLOSS  +  CMS(3)*ZLOSS 

YLOSM  =  CMS(4)*XLOSS  +  CMS<5)*YLOSS  +  CMS(6)*ZLOSS 

ZLOSM  =  CMS(7)*XLOSS  +  CMS(8)*YLOSS  +  CMS{9)*ZLOSS 

C  ROTATE  MEASURED  LOS  VECTOR  INTO  INERTIAL  FRPME 


XLOSI  =  TI2MO(l) *XLOSM  +  TI2MO (2) *YLOSM  +  TI2MO (3) *ZLOSM 
YLOSI  =  TI2MO(4) *XLOSM  +  TI2MO (5) *YLOSM  +  TI2MO ( 6) *ZLOSM 
ZLOSI  =  TI2MO(7) *XLOSM  +  TI2MO (8) *YLOSM  -  TI2MO < 9) *ZLOSM 


C  DETERMINE  MEASURED  LOS  ANGLES  IN  INERTIAL  FRAME 


PLAMM  =  ATAN2  (  -ZLOSI  ,  XLOSI  ) 

YLAMM  =  ATAN2  (  YLOSI  ,  XLOSI  ) 

C  EXECUTE  FILTER  INITIALIZATION  LOGIC  ON  FIRST  FILTER  PASS 


THE  FOLLOWING  INITIALIZATION  IS  DONE  HERE,  RATHER  THAN  IN  THE 
INITIAL  SECTION  TO  AVOID  REPETITIVE  CALCULATIONS  TO  OBTAIN  THE 
VALUES  OF  PLAMM  AND  YLAMM 

IF  (  IFPAS.EQ.l  )  THEN 

PLAMHl  =  PLAMM 
PLAMH  =  PLAMHl 
YLAMHl  =  YLAMM 
YLAMH  =  YLAMHl 

ENDIF 

DETERMINE  TIME  SINCE  LAST  FILTER  UPDATE 

IF  {  T.GT.TKF  )  THEN 
DTKF  =  T  -  TKF 
ELSE 

DTKF  =  O.OEO 
ENDIF 

TKF  =  T 

ENABLE  FIRST  BURN  WHEN  DATA  RATE  IS  SUFFICIENT  (SEEKER  TYPE  2) 
OR  WHEN  IN  TERMINAL  MODE  (SEEKER  TYPE  3) 

IF  (  (SEKTYP.EQ.2.AND.FRMRAT.GE.RATE(5) .AND.IDRTOK.EQ.O)  .OR. 
(SEKTYP.EQ..3  .AND.  IDRTOK.EQ.O  .AND.  MTERM.EQ.l)  )  THEN 
TGEl  =  TGO  -  RNHITS/FRMRAT 
IBURNl  =  0 
IDRTOK  =  1 
ENDIF 

C  ENABLE  ACQUISITION  MODE  ON  FIRST  PASS 

IF  (  (SEKTYP.NE.3  .AND.  KF.MODE .  EQ .  1  .AND.  SNRO .  GE  .  SNRACQ)  .OR. 
(SEKTYP.EQ.3  .AND.  KFMODE.EQ.l  .AND.  MACQ.EQ.l)  )  THEN 
WRITE (MESSAGE, 101)  T, MACRO 
CALL  OUTMES (MESSAGE) 
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101  FORMAT (IX, El 6. 9, '  ACQUISITION  MODE  ENABLED:  MACRO  =  ',E16.9) 

KFMODE  =  2 

ACQD  =  1 

ELSEIF  ( (SEKTYP.NE.3  .AND.  KFMODE. EQ. 2  .AND.  SNRO .GE . SNRTRK)  .OR. 
(SEKTYP.EQ.3  .AND.  KF.MODE.EQ.2  .AND.  MACQ.EQ.l)  )  THEN 

REINITIALIZE  ERROR  COVARIANCE  DIAGONAL  ELEMENTS  SWITCH  F.RO.M 
ACQUISITION  TO  TRACK  MODE 

WRITE (MESSAGE, 102)  T, MACRO 
CALL  OUTMES (MESSAGE) 

102  FORMAT (IX, El 6.9,  '  TRACK  MODE  ENABLED:  MACRO  =  ',E16.9) 

KFMODE  =  3 

MAGRSQ  =  MACRO* *2 
TGOSQ  =  TGO**2 

PPll  =  PPll  +  TKSHFT(3) **2/MAGRSQ 

PYll  =  PYll  +  TKSHFT(2) **2/MAGRSQ 

PP22  =  PP22  +  TKSHFT(3) **2/(MAGRSQ*TGOSQ) 

PY22  =  PY22  +  TKSHFT(2)**2/(MAGRSQ*TGOSQ) 

END  IF 

IF  (  KFMODE. GE. 3  .AND.  IFPAS .GE . NINT (RNHITS)  )  ESTATE  =  0 

REINITIALIZE  ERROR  COVARIANCE  DIAGONAL  ELEMENTS  AT  SWITCH  FROM 
TRACK  TO  DISCRIMINATION  MODE 


IF  (  (SEKTYP.NE.3  .AND.  KFMODE. EQ. 3  .AND.  SNRO .GE . SNRCSO)  .OR. 
(SEKTYP.EQ.3  .AND.  KFMODE. EQ. 3  .AND.  MCS0.2Q.1)  )  THEN 
WRITE (MESSAGE, 103)  T, MACRO 
CALL  OUTMES (MESSAGE) 

103  FORMAT (IX, El 6. 9, '  CSO  MODE  ENABLED:  MACRO  =  ',E16.9) 

KFMODE  =  4 
MAGRSQ  =  MACRO* *2 
TGOSQ  =  TGO**2 

PPll  =  PPll  +  CSSHFT(3) **2/MAGRSQ 
PYll  =  PYll  +  CSSHFT(2) **2/MAGRSQ 
PP22  =  PP22  +  CSSHFT(3) **2/ (MAGRSQ*TGOSQ) 

PY22  =  PY22  +  CSSHFT(2) **2/(MAGRSQ*TGOSQ) 

END  IF 


REINITIALIZE  ERROR  COVARIANCE  DIAGONAL  ELEMENTS  AT  SWITCH  FROM 
DISCRIMINATION  TO  TERMINAL  MODE  (SEEKER  TYPE  2)  OR  FRAME  RATE 
EQUALS  12.5  (SEEKER  TYPE  3)  AND  ENABLE  SECOND  BURN 


IF  (  (SEKTYP.NE.3  .AND.  KFMODE. EQ. 4  .AND.  SNRO .GE . SNRTRM)  .OR. 
(SEKTYP.EQ.3  .AND.  KFMODE. EQ.  4  .AND.  FRMR.>^T . GE  . RATE  ( 3 )  )  )  ■: 
WRITE (MESSAGE, 104)  T, MACRO 
CALL  OUTMES (MESSAGE) 

104  F0RMAT(1X,E16.9, '  TERMINAL  MODE  ENABLED :  MACRO  =  ',E16.9) 


'HEN 


KFMODE 
TGE2AL 
TRMTGO 
MAGRSQ 
TGOSQ 
PPll 
PYll 
PP22 
PY22 
END  IF 


5 

TGO  -  RNHITS/FRMRAT 
TGO  -  RNHITS/FRMRAT 
MACRO* *2 
TGO**2 

TMSHFT(3) * *2 /MAGRSQ 
TMSHFT(2) 


PPll 

PYll 

PP22 

PYP'l 


*2 /MAGRSQ 
TMSHFT (3) **2/ (MAGRSQ*TGOSQ) 
TMSHFT  (2)  **2/  (t4AGRSQ*TGOSQ) 


C  COMPUTE  R  (  MEASUREMENT  NOISE  MATRIX  )  FOR  CURRENT  TIME 
RV  =  AKSGME  *  ASIG**2 
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C  PROCESS  NOISE  TERMS  AS  A  FUNCTION  OF  HOMING  PHASE 

IF  (  KFMODE.GT.2  .AND.  KFMODE.LT.5  )  THEN 
RW  :=  SGWH**2 

ELSE  IF  (  KFMODE.EQ.5  )  THEN 
RW  =  SGWT**2 

END  IF 


C  COMPUTE  Q  (  PROCESS  NOISE  MATRIX  )  FOR  CURRENT  TIME 

Qll  =  RW  *  DTKF**2  /  4.0E0 

Q12  =  RW  *  DTKF  /  2.0E0 

Q22  =  RW 

C  EXTRAPOLATE  COVARIANCE  MATRIX  TO  CURRENT  TIME 
C  P(N+1)  =  PHI  (N)  *P(N)  *P.-1I(N)T  Q 

PPX  =  PP12  +  DTKF*PP22 

PYX  =  PY12  +  DTKF*PY22 

PPll  =  Qll  +  PPll  +  DTKF* (PP12+PPX) 

PYl]  =  Qll  +  PYll  i-  DTKF*  (PY12+PYX> 

PP12  =  C12  +  PPX 

PY12  "  Q12  +  PYX 

PP22  =  Q22  +  PP22 

PY22  =  Q22  +  PY22 


C  COMPUTE  KALMAN  FILTER  GAIN  MATRIX  : 

C 

C  K(N)  =  P(N)  *HT*(  H*P(N)  *HT  +  RV  ) **-l 


DNP  =  PPll  +  RV 

DNY  =  PYll  +  RV 

AKPll  =  PPll  /  DNP 

AKYll  =  PYll  /  DNY 

AKP21  =  PP12  /  DNP 

AKY21  =  PY12  /  DNY 


IF  (  AKPll, GT.GFLIM  )  AKPll  =  GFLIM 

IF  {  AKYll. GT.GFLIM  )  AKYll  =  GFLIM 

IF  (  AKP21.GT.GFDLIM  )  AKP21  =  GFDLIM 

IF  (  AKY21,GT. GFDLIM  )  AKY21  =  GFDLIM 


C  COMPUTE  FILTER  BANDWIDTH  AND  DAMPING 


IF  (  AKP21.GT.0.0E0  .AND  DTKF .GT . 0 . OEO  )  THEN 
WFILT  =  SQRT  (  AKP21  /  DTKF  ) 

ZFILT  =  AKPll  *  WFILT  /  (  2. OEO  *  AKP21  ) 
END  IF 


C  UPDATE  COVARIANCE  MATRIX  ; 

C  + 

C  P(N)  =  (  I  -  K(N)  *H  )  *  P{N) 


PP22 

=  PP22 

-  AKP21*PP12 

PY22 

=  PY22 

-  AKy21*PY12 

PP12 

=  PP12 

-  AKP21*PP11 

PY12 

=  PY12 

-  AKY21*PY11 

PPll 

=  PPll 

-  AKP11*PP11 

PYll 

=  PYll 

-  AKYll *PYil 

C  ESTIMATE  DELTA  LOS  ANGULAR  RATE  DUE  TO  MISSILE  MOTION  ( 
C  INPUT  OR  FORCING  FUNCTION  ) 

PLMDF  =  (  RZI*VXI  -  RXI*VZI  )  /  (  RXI**2  +  RZI**2  ) 


'PLANT' 
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m 

Ik 


YLMDF  =  (  RXI*VYI  -  RYI’-VXI  )  /  (  RXI**2  +  RYI**2  ) 

IF  (  DTKF.NE.O.OEO  )  THEN 

DLPLMD  =  (  PLMDF  -  PLMDFP  ) 

DLYLMD  =  (  YLMDF  -  YLMDFP  ) 

ELSE 

DLPLMD  =  O.OEO 

DLYLMD  =  O.OEO 

ENDIF 

PLMDFP  =  PLMDF 
YLMDFP  =  YLMDF 

C  EXTRAPOLATE  FILTERED  INERTIAL  FRAf^E  STATES  TO  CURRENT  TIME 

PLAMHl  =  PLAMH  +  DTKF  *  {  PLAMDH  +  0 . 5E0*DTKF*DLPLMD  ) 

YLAMHl  =  YLAMH  +  DTKF  *  (  YLAMDH  +  0 . 5E0*DTKF*DLYLMD  ) 

PLMDHl  =  PLAMDH  +  DLPLMD 
YIMDHl  =  YLAMDH  +  DLYLMD 

REVISE  FILTER  ESTIMATES  OF  INERTIAL  FRAME  LAMBDA  AND  LAMBDA  DOT  : 

A  I  A 

X{N)  =  X(N)~+  K(N)*(  Y(N)  -  H*X(N)“) 

ERRP  =  PLAMM  -  PLAMHl 

ERRY  =  YLAMM  -  YLAMHl 

PLAMH  =  PLAMHl  +  AKP11*ERRP 
PLAMDH  =  PLMDHl  +  AKP21*ERRP 
YLAMH  =  YLAMHl  +  AKY11*ERRY 
YLAMDH  =  YLMDHl  +  AKY21*ERRY 

C  EXTRAPOLATE  LOS  ANGLES  AHEAD  TO  ACCOUNT  FOR  SIGNAL  PROCESSING  LAG 

IF  (  DTKF.NE.O.OEO  )  THEN 

DLPLMD  =  DLPLMD  *  SPLAG  /  DTKF 

DLYLMD  =  DLYLMD  *  SPLAG  /  DTKF 

ELSE 

DLPLMD  =  O.OEO 

DLYLMD  =  O.OEO 

ENDIF 

PLAMF  =  PLAMH  +  SPLAG  *  (  PLAMDH  +  0 . 5E0*SPLAG*DLPLMD  ) 

YLAMF  =  YLAMH  +  SPLAG  *  (  YLAMDH  +  0 . 5E0*SPLAG*DLYLMD  ) 

PLAMDF  =  PLAMDH  +  DLPLMD 
YLAMDF  =  YLAMDH  +  DLYLMD 

C  RECONSTRUCT  FILTERED  LOS  VECTOR  IN  INERTIAL  FRAME 

TANPCH  =  TAN  (  PLAMF  ) 

TAN YAW  =  TAN  (  YLAMF  ) 

COSPSQ  =  COS  (  PLAMF  )  **2 

COSYSQ  =  COS  (  YLAMF  )  **2 

XLOSI  =  l.OEO  /  SQRT  (  l.OEO  +  TANlOH**2  +  TANYAW**2  ) 

YLOSI  =  XLOSI  *  TANYAW 

ZLOSI  =  -  XLOSI  *  TANPCH 

C  DETERMINE  FILTERED  LOS  VECTOR  RATES  IN  INERTIAL  FRAME 

XLOSDI  =  -  (  PLAMDF* TANPCH /COSPSQ 

+  YLAMDF*TANYAW/COSYSQ  )  *  XLOSI* *3 
YLOSDI  =  YLAMDF*XLOSI  /COSYSQ  +  XLOSDI*TANYAW 


332 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


ZLOSDI  =  -  PLAMDF*XLOSI  /COSPSQ  -  XLOSDI*TMPCH 

C  ROTATE  LOS  VECTOR  INTO  MISSILE  FRAME 

XLOSM  =  TI2M(1) *XLOSI  +  TI2M(4) *YLOSI  +  TI2M(7) *ZLOSI 

YLOSM  =  TI2M(2) *XLOSI  +  TI2M (5) *YLOSI  +  TI2M ( 8) *ZLOSI 

ZLOSM  =  TI2M(3) *XLOSI  +  TI2M(6) *YLOSI  +  TI2M(9) *ZLOSI 

C  ROTATE  LOS  VECTOR  RATES  INTO  MISSILE  FRAME 


XLOSDM  =  TI2M(i; *XLOSDI  +  TI2M(4) *YLOSDI  +  TI2M (7 ) *ZLOSDI 
YLOSDM  =  TI2M(2) *XLOSDI  +  TI2M ( 5) *YLOSDI  +  TI2M (8) *ZLOSDI 
ZLOSDM  =  TI2M(3) *XLOSDI  +  TI2M ( 6) *YLOSDI  +  TI2M ( 9) *ZLOSDI 

C  ROTATE  LOS  VECTOR  INTO  SEEKER  FRAME 


XLOSS  =  CMS(l)*XLOSM  +  CMS(4)*YLOSM  +  CMS(7)*ZLOSM 
YLOSS  =  CMS(2)*XLOSM  +  CMS(5)*YLOSM  +  CMS(8)*ZLOSM 
ZLOSS  =  CMS(3)*XLOSM  +  CMS{6)*YLOSM  +  CMS(9)*ZLOSM 

C  ROTATE  LOS  VECTOR  RATES  INTO  SEEKER  FRAME 


XLOSDS  =  CMS(l) *XLOSDM  +  CMS (4) *YLOSDM  +  CMS (7 ) *ZLOSDM 
YLOSDS  =  CMS (2) *XLOSDM  +  CMS (5) *YLOSDM  +  CMS (8) *ZLOSDM 
ZLOSDS  =  CMS(3) *XLOSDM  +  CMS ( 6) *YLOSDM  +  CMS ( 9) *ZLOSDM 


C  DETERMINE  LOS  ANGLES  IN  SEEKER  FRAME 


LAM(l)  =  ATAN2  (  -ZLOSS  ,  XLOSS  ) 

LAM (2)  =  ATAN2  (  YLOSS  ,  XLOSS  ) 

C  DETERMINE  LOS  ANGULAR  RATES  IN  SEEKER  FRAME 

TANPCH  =  TAN  (  LAM(l)  ) 

TANYAW  =  TAN  (  LAM (2)  ) 

COSPSQ  =  COS  (  LAM(l)  )  **2 

COSYSQ  =  COS  {  LAM(2)  )  **2 

LAMDd)  =  (  -  ZLOSDS  -  XLOSDS*TANPCH  )  *  COSPSQ  /  XLOSS 

LAMD(2)  =  (  YLOSDS  -  XLOSDS*TANYAW  )  *  COSYSQ  /  XLOSS 

C  DETERMINE  ATTITUDE  ERRORS 


IF  (  ESTATE 

.EQ.  0  )  THEN 

PITER  = 

LAM(l) 

YAWER  = 

-LAM(2) 

ROLLER  = 

0.0 

END  IF 

RETURN 

END 
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B.2.19  Uu.ni3x3i.for 


— 

SUBROUTINE  M3X3I  {  A 

,  B  ) 

SUBROUTINE  NAME  : 

M3X3I 

AUTHOR (S)  : 

D.  F.  SMITH 

FUNCTION  : 

Compute  the  inverse  of  a  3  by  3  matrix  . 

'■ALLED  FROM  : 

UTILITY  ROUTINE 

SUBROUTINES  CALLED  : 

NONE 

INPUTS  : 

A 

OUTPUTS  : 

B 

UPDATES  : 

NONE 

IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (O-Z) 

DOUBLE  PRECISION  A (3, 3),  B{3,3) 


DET  =  A{1  i) *A(2,2) *A(3,3)  -  A(l, 1) *A (2, 3) *A (3, 2) 
+  A(1,2)*A<2,3)*A(3,1)  -  A(l, 2) *A (2, 1) *A (3, 3) 
+  A(1,3)*A(2,1)*A(3,2)  -  A(l, 3) *A (2, 2) *A (3, 1) 


IF  (  DET. 

NE. 

.O.ODO  )  THEN 

- 

{  A(2,2)  *A(3,3) 

-  A(2,3)  *A{3,2) 

) 

/ 

DET 

B(2,l) 

= 

{  A(2,3)  *A(3,1) 

-  A(2,1)*A(3,3) 

) 

/ 

DET 

B(3,l) 

=S 

(  A(2,  1)  *A(3,2) 

-  A(2,2) *A(3, 1) 

) 

/ 

DET 

B(l,2) 

as 

(  A(l,3) *A(3,2) 

-  A(1,2)*A(3,3) 

) 

/ 

DET 

B(2,2) 

= 

(  A(l,l)  *A(3,3) 

-  A(1,3)*A(3,1) 

) 

/ 

DET 

B(3,2) 

= 

(  A(l,2)  *A(3,1) 

-  A(l,l) *A(3,2) 

) 

/ 

DET 

B(l,3) 

= 

(  A(l,2)  *A(2,3) 

-  A(l,3) *A(2,2) 

) 

/ 

DET 

B(2,3) 

=s 

(  A(l,3)  *A(2,1) 

-  A(l,l) *A(2,3) 

) 

/ 

DET 

B(3,3) 

S= 

(  A(1,1)*A(2,2) 

-  A(l,2) *A(2,1) 

) 

/ 

DET 

ELSE 

= 

O.ODO 

B(2,l) 

O.ODO 

B(3,l) 

= 

O.ODO 

B(l,2) 

O.ODO 

B(2,2) 

O.ODO 

B(3,2) 

= 

O.ODO 

B(l,3) 

O.ODO 

B(2,3) 

O.ODO 

B(3,3) 

=S 

O.ODO 

END  IF 

RETURN 

END 
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B,2.20  Uumasspr.for 

c - 

SUBROUTINE  MASSPR (T, MDOTA, MDOTV, MASS, EISP, IMASS, 

MDOT, WEIGHT, WDOTTP,WDOTKV,WDOTT I, IXX, 
IYy,IZZ) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 
FUNCTION  : 

CALLED  FROM  : 


MASSPR 
B.  HILL 

CALCULATE  MISSILE  MASS  PROPERTIES 
MAIN 


SUBROUTINES  CALLED  ;  TABLE 


INPUTS  : 


T, MDOTT, MDOTF, MDOTA, MDOTV, MASS, EISP 


OUTPUTS 


MDOT, WEIGHT, WDOTTP, WDOTFR, WDOTKV, WDOTTI, CG, 
IXX, lYY, IZZ 


BOTH 


TBRK, IMASS 


UPDATES 


D. 

SMITH 

-  CR 

# 

059 

D. 

SISSOM 

-  CR 

# 

069 

D. 

SMITH 

-  CR 

# 

076 

D. 

SMITH 

-  CR 

# 

080 

B. 

HILL  / 

-  CR 

# 

081 

R. 

R. 

RHYNE 

RHYNE 

-  CR 

# 

087 

B. 

HILL 

-  CR 

# 

089 

B. 

HILL 

-  CR 

# 

093 

IMPLICIT  REAL 

(A-H) 

IMPLICIT  REAL 

(0-Z) 

REAL 

INERXX(20) 

,  INERYY(20) 

REAL 

INERZZ (20) 

,  IXX 

,  lYY 

REAL 

IZZ 

,  MASS 

,  MASSL 

REAL 

MASSTl (20) 

,  MASST2(20) 

,  MDOT 

REAL 

MDOTA 

,  MDOTV 

C  LOCAL  COMMON  USED  TO  HOLD  CONSTANTS  AND  INITl.^iLIZATION  FLAG 

SAVE  IDATIN  ,  BISP 

C  COMMON  "RMASS"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RMASS  /  TLSTM  ,  MASSL 

*  DATA  INITIALIZATION 
$  INCLUDE  (  '  '^/INCLUDE /SSDATA4  5  .DAT  ' ) 

$JNCLUDE (  "'/INCLUDE/SSDATASe .DAT’ ) 

SINCT.UDF,  (  '  ''/INCLUDE,/SSDA.TA22  .DAT'  > 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA2  3  .DAT' ) 

DATA  ID.ATIN  /  1  / 

DATA  ICG  /  1  /,  III  /  1  / 
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IF  (IMASS  .EQ.  1)  THEN 
IMASS  =  0 

IF  (IDATIN  .EQ.  1)  THEN 
IDATIN  =  0 

C  ZERO  BOOSTER  SPECIFIC  IMPULSE  AFTER  SECOND  STAGE 

BISP  =  0.0 
EISP  =0.0 
END  IF 

END  IF 

C  CALCULATE  TOTAL  MASS  FLOW  RATE 

MDOT  =  -  MDOTA  -  MDOTV 
C  CONVERT  MASS  TO  WEIGHT 

WEIGHT  =  MASS*XMTOF 

C  CALCULATE  WEIGHT  EXPULSION  RATES 

WDOTTP  =0.0 
WDOTTI  =0.0 

WDOTKV  =  (-  MDOTA  -  MDOTV) *XMTOF 

C  CALCULATE  MISSILE  MOMENT  OF  INERTIA 

CALL  spTABLE(MASST2, INERXX, MASS, IXX, 20, III) 

CALL  spTABLE (MASST2 , INERYY, MASS, lYY, 20, III) 

CALL  spTABLE (MASST2, INERZZ,MASS,  IZZ, 20,  III) 

RETURN 

END 
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B.2.21  Uumcauto.for 

c - 

SUBROUTINE  MCAUTO (T, IXX, lYY, IZZ, SP, SQ,  SR, ROLLER,  PITER, YAWER, IDIST, 
iACSON, IBURND, IBURNM, IDMEAS, IPASSM, ICMD, TRATON, 
TPATON,TYATON,DTSAMP,TSAL,TSAK,TLAPS, ITHRES, 
ANVP, ACSLEV, TMAUTO, initf lag) 


SUBROUTINE  NAME  : 
AUTHOR  : 
FUNCTION 

CALLED  FROM  : 


MCAUTO 
R.  RHYNE 

GENERATES  ACS  COMMANDS  TO  NULL  LARGE 
ATTITUDE  ERRORS  AND  RATES  DURING  MIDCOURSE 

FORTRAN  t4AIN 


SUBROUTINES  CALLED  :  NONE 


INPUTS  :  T,IXX,IYY,  IZZ, SP,SQ,  SR,  ROLLER, PITER, 

YAWER, IDIST, IACSON, IBURND, IBURNM, IDMEAS 

OUTPUTS  :  ICMD, TRATON, TPATON,TYATON,DTSAMP,TSAL,TSAH, 

TLAPS, ITHRES, ANVP, ACSLEV, TMAUTO 


BOTH 


IPASSM 


UPDATES  : 


B.  HILL  / 

R.  RHYNE 

1 

o 

# 

081 

D.  SMITH 

-  CR 

# 

082 

R.  RHYNE 

-  CR 

# 

083 

R.  RHYNE 

-  CR 

# 

087 

R.  RHYNE 

-  CR 

# 

090 

D.  SMITH 

-  CR 

# 

092 

B,  HILL 

-  CR 

# 

093 

IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 


REAL  11(3) 

REAL  OMEGA (3) 
REAL  AERROR(3) 
REAL  IXX 
INTEGER 


,  ANGACL(3,4, 10) ,  OMEGAI(3) 

,  TBURNA(3)  ,  MOMARM(3) 

,  OMEGAD  ,  AACCEL(3,4) 

,  lYY  ,  IZZ 

IMCPAS(3,4),  initf lag 


C  COMMON  "RMAUTO"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 


CO.MMON  /  RMAUTO  /  ANGACL  , 

IMCPAS  , 

TP 2 END 

TCOAST  , 

ICOA3T  , 

TRDONE 

IACSB2  , 

ICNT  , 

IVPFL 

OMEGA I  , 

TLSTMA  , 

AACCEI, 

TP3END  ,  IP2END  , 
IRATE  ,  lACSBl  , 
IVPFLN  ,  TBURN2  , 


*  DATA  INITIALIZATION 
$  INCLUDE  ( ' INCLUDE/ SSDATA5  9  .DAT ' ) 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA60  .  DAT ' ) 
SINCLUDE  (  ’  ''/INCLUDE/SSDATAOi  .DAT  '  ) 
$  INCLUDE  ( ' ''/ INCLUDE /SSDATA02  .DAT ' ) 
$  INCLUDE  ( ’  ''/INCLUDE /SSDATAO  5  .DAT' ) 
$  INCLUDE  { ''•/  INCLUDE /SSDATAO  7  .  DAT  ’ ) 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA08  .DAT' ) 
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$  INCLUDE  ( '  ''/INCLUDE/ SSDATA19.DAT  ' ) 

IF  (  IPASSM.EQ.O  )  THEN 

C  INITIALIZE  ACCELERATION  TABLE,  PULSE  FLAGS,  AND  PULSE  TIMES 

MOMARM(l)  =  RIARM 
MOMARM{2)  =  PIARM 
MOMARM(3)  =  YIARM 
11(1)  =  IXX 

II{2)  =  lYY 

II{3)  =  IZZ 

DO  10  I  =  1,3 

ANGACLd,  1, 1)  =  2  ..*ACSFL*MOMARM(I) /II  (I) 

ANGACL(I,2, 1)  =  2.*ACSFH*MOMARM(I) /II (I) 

IF  (  I.EQ.l  )  THEN 

ANGACLd,  3,1)  =  4.*ACSFL*MOMARMd) /lid) 

ANGACLd,  4,1)  =  4.*ACSFH*MOMARMd) /Ild) 

ELSE 

ANGACLd, 3,1)  =  0. 

ANGACLd,  4,1)  =  0. 

END  IF 

DO  4  J  =  1,4 

IMCPASd,J)  =  1 
AACCELd,J)  =  ANGACLd,J,  1) 

DO  3  K  =  2,10 

ANGACLd, J,K)  =  0. 

CONTINUE 
CONTINUE 
CONTINUE 
IPASSM  =  1 
ICNT  =  0 
IP2END  =  1 
ICOAST  =  1 
TP2END  =  1000.0 
TP3END  =  1000.0 
TCOAST  =  1000.0 
TRDONE  =  1000.0 
END  IF 

if  (initflag  .ne.  0  )  then 

C  TIME  SINCE  LAST  CALL 

DTMCA  =  T  -  TLSTMA 
TLSTMA  =  T 

C  DETERMINE  IF  CORRECTION  REQUIRED  AND  ISSUE  APPROPRIATE  COMMAND 

IF  (  ICMD.EQ.O  .AND.  IDIST.EQ.O 

.AND.  IBURNM.NE.O  .AND.  IBURND.EQ.O  )  THEN 

IF  (  ABS (ROLLER) .GE.CAPHL  )  THEN 

C  COMPUTE  INITIAL  ROLL  CORRECTION  BURN  TIME 

ICMD  =  1 
IVPFL  =  3 
lACSBl  =  1 

IF  (  ABS (ROLLER) .GE. 4. *CA?KL  )  IVPFL  -  2 
OMEGAD  =  ROLLER*AACCEL(l, IVPFL) /ABS (ROLLER) 

IF  (  SP /ROLLER. LT.O.  )  THEN 

RLLERO  =  ROLLER  +  SP**2/ (2 . *OMEGAD) 

ELSE 


3 

4 

10 


338 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


RLLERO  =  ROLLER 
ENDIF 

TBACS  =  SORT (ABS (RLLERO)/ (2. *AACCEL (1, IVPFL) ) ) 

ELSEIF  (  ABS (SP) .GT.CRPHL  )  THEN 

C  DEFINE  ROLL  RATE  CORRECTION  COMMAND 

ICMD  =  1 
IRATE  =  1 
lACSBl  =  1 

IF  (  ABS(SP) .GT.750.*CRPH  )  THEN 
IVPFL  =  4 

ELSEIF  (  ABS (SP) .GT.375.*CRPH  )  THEN 
IVPFL  =  2 

ELSEIF  (  ABS (SP) .GT.15.*CRPH  )  THEN 
IVPFL  =  3 
ELSE 

IVPFL  =  1 
ENDIF 

ELSEIF  (  IDMEAS.NE.2  )  THEN 

IF  (  ABS (PITER) .GT.CATHL  )  THEN 

C  COMPUTE  INITIAL  PITCH  CORRECTION  BURN  TIME 

OMEGAD  =  PITER*AACCEL(2,2) /ABS (PITER) 

IF  (  SQ/PITER.LT.O.  )  THEN 

PITERO  =  PITER  +  SQ''*2/ (2  .  "OMEGAD) 

ELSE 

PITERO  =  PITER 
ENDIF 

TBACS  =  SQRT(ABS(PITER0)/(2.*AACCEL(2,2) ) ) 

C  ISSUE  PITCH  COMMAND 

ICMD  =  2 
IVPFL  =  2 
lACSBl  =  1 

ELSEIF  (  ABS (YAWER) .GT.CAPSL  )  THEN 

OMEGAD  =  YAWER*AACCEL(3,2) /ABS (YAWER) 

IF  (  SR/YAWER.LT.O.  )  THEN 

YAWERO  =  YAWER  +  SR**2/ (2 . "OMEGAD) 

ELSE 

YAWERO  =  YAWER 
ENDIF 

TBACS  =  SQRT(ABS(YAWER0)/(2."AACCEL(3,2))) 

C  ISSUE  YAW  COMMAND 

ICMD  =  3 
IVPFL  =  2 
lACSBl  =  1 

ELSEIF  (  TSAH.GT.T+TSMPH+EPSL  .AND.  IDMEAS.EQ. 

C  ENABLE  KV  AUTOPILOT 

TSAL  =  T 
TSAH  =  T 
TLAPS  =  T 


-  SP/ OMEGAD 


SQ/OMEGAD 


SR/OMEGAD 


)  THEN 
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ENDIF 

ELSEIF  (  IBURND.EQ.O  )  THEN 

NULL  BODY  RATES  BEFORE  DISTURBANCE  PULSE  ISSUED 

IF  (  ABS (SQ) .GE.CRTH  )  THEN 
ICMD  =  2 
X\^PFL  =  1 

IF  (  ABS(SQ) .GT.35.*CRTH  )  IVPFL  =  2 
IRATE  =  1 
lACSBl  =  1 

ELSEIF  (  ABS(SR) .GE.CRPS  )  THEN 
ICMD  =  3 
IVPFL  =  1 

IF  (  ABS{SR) .GT.35.*CRPS  )  IVPFL  =  2 
IRATE  =  1 
lACSBl  =  1 
ENDIF 

ENDIF 

ENDIF 

EXECUTE  CONTROL  LOGIC  IF  ATTITUDE/RATE  CORRECTION  REQUIRED 
IF  (  ICMD.NE.O  )  THEN 

ZERO  ACS  BURN  VECTOR  AND  FORM  ANGULAR  RATE  AND  ERROR  VECTORS 

TBURNAd)  =  0. 

TBURNA{2)  =  0. 

TBURNA(3)  =  0. 

OMEGA (1)  =  SP 
OMEGA (2)  =  SQ 
OMEGA (3)  =  SR 

AERROR(l)  =  ROLLER 
AERROR(2)  =  PITER 
AERROR(3)  =  YAWER 

UPDATE  ANGULAR  ACCELERATION  TABLE 

IF  (  lACSON.EQ.l  )  THEN 
ICNT  =  ICNT  +  1 

IF  (  ICNT.EQ.l  )  OMEGAI(ICMD)  =  OMEGA (ICMD) 

IF  (  ICNT.GE.2  )  THEN 

DO  12  I  =  IMCPAS (ICMD, IVPFL) ,1^-1 

IF  (I.LT.IO)  ANGACL (ICMD, IVPFL, I+l)  = 

ANGACL( ICMD, IVPFL, I) 

CONTINUE 

ANGACL (ICMD, IVPFL, 1) =ABS (OMEGAI (ICMD) -OMEGA (ICMD) ) /DTMCA 
OMEGAI(ICMD)  =  OMEGA (ICMD) 

IMCPAS (ICMD, IVPFL)  =  IMCP AS ( ICMD, IVPFL)  +  1 
IF  (IMCPAS (ICMD, IVPFL) .GE.ISAMP)  IMCPAS ( ICMD, IVPFL) =ISAMP 
ENDIF 
ELSE 

ICNT  =  0 
ENDIF 

COMPUTE  EXPECTED  ANGULAR  ACCELERATION 

AACCEL( ICMD, IVPFL)  =0.0 
DO  20  I  =  1, IMCPAS (ICMD, IVPFL) 
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AACCELdCMD,  IVPFL)  =  AACCELdCMD,  IVPFL) +ANGACL  (ICMD,  IVPFL,  I) 
CONTINUE 

AACCELdCMD,  IVPFL)  =  AACCEL (ICMD,  IVPFL)  / 

(IMCPAS (ICMD, IVPFL) ) 


EXECUTE  BURN  LOGIC 

IF  (  IRATE. EQ.l  )  THEN 

RATE  CORRECTION 

IF  (  lACSBl.EQ.l  )  THEN 

TBURNAdCMD)  =  -OMEGA (ICMD) /AACCEL  (ICMD,  IVPFL) 

DTSAMP  =  ABS(TBURNA(ICMD) ) 

TRDONE  =  T  +  DTSAMP  +  TLAGA  +  TRDNA 

ITHRES  =  1 

lACSBl  =  0 

ICNT  =  0 

TSAL  =  1000. 

TSAH  =  1000. 

TLAPS  =  1000. 

ELSEIF  (  T.GE. TRDONE  )  THEN 
TRDONE  =  1000. 

IRATE  =  0 
ICMD  =  0 
END  IF 

ELSEIF  (  lACSBl.EQ.l  )  THEN 

ENABLE  FIRST  ATTITUDE  CONTROL  PULSE 

TBURNAdCMD)  =  AERROR (ICMD)  *TBACS/ABS  (AERROR ( ICMD)  ) 

DTSAMP  =  ABS(TBURNA(ICMD) ) 

ITHRES  =  1 

TCOAST  =  T  +  DTSAMP  +  TLAGA  +  TRDNA 

ICOAST  =  0 

lACSBl  =  0 

ICNT  =  0 

TSAL  =  1000. 

TSAH  =  1000. 

TLAPS  =  1000. 

ELSEIF  (  T.GE. TCOAST  .AND.  ICOAST. EQ.O  )  THEN 

COMPUTE  SECOND  BURN  TO  LEAVE  DESIRED  LOW  LEVEL  BURN 

ICOAST  =  1 
IACSB2  =  1 

IF  (  OMEGA (ICMD) .LT.O.  )  THEN 
DIRECT  =  -1. 

ELSE 

DIRECT  =  1.. 

END  IF 

IF  (  ICMD. EQ.l  .AND.  IVPFL. EQ. 2  )  THEN 
IVPFLN  =  3 
ELSE 

IVPFLN  =  1 
END  IF 

TBURN2=  (OMEGA  (ICMD)  -DIRECT*.AACCEL  (IC.MD,  IVPFLN)  *TBURN3) 

/AACCELdCMD,  IVPFL) 

ELSEIF  (  T.GE. TCOAST  .AND.  IACSB2.EQ.1  )  THEN 

ENABLE  ACS  BURN  WHEN  ATTITUDE  ERROR  EQUALS  EXPECTED 
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C  DISTANCE  FROM  DESIRED  LOW  LEVEL  THIRD  PULSE  ERROR 

THET2D  =  OMEGA (ICMD)  -  AACCEL ( ICMD, IVPFL) *TBURN2 
THT2DD  =  -DIRECT*AACCEL(ICMD, IVPFLN) 

THTIDD  =  -DIRECT*AACCEL( ICMD, IVPFL) 

DELANG  =  0.5* {THET2D**2  -  OMEGA ( ICMD) **2) /THTIDD  + 
2.*THET2D*TBURN3  -  0 . 5*THET2D**2/THT2DD 
DELNXT  =  AERROR(ICMD)  -  OMEGA (ICMD) *DTMCU 
IF  (  ABS (DELANG) .GE.ABS (DELNXT)  )  THEN 
IACSB2  =  0 
ICNT  =  0 

TBURNA(ICMD)  =  -TBURN2 
DTSAMP  =  ABS (TBURNA( ICMD ) ) 

ITHRES  =  1 
IP2END  =  1 

TP2END  =  T  +  DTSAMP  +  TLAGA  +  TRDNA 
DELANG  =  0. 

END  IF 

ELSEIF  (  T.GE.TP2END  .AND.  IP2END.EQ.1  )  THEN 

C  DEFINE  LOW  LEVEL  ACS  PULSE  FOR  'FINE  TUNING' 

DELANG  =  0.5*OMEGA(ICMD) **2/AACCEL(ICMD, IVPFLN) 

DELNXT  =  AERROR(ICMD)  -  OMEGA ( ICMD) *DTMCU 

TDELAN  =  (ABS (AERROR (ICMD) )  -  DELANG) /ABS (OMEGA ( ICMD) ) 

IF  (  DELANG. GE.ABS (DELNXT)  .OR.  TDELAN . GT . 2 . 5*TBURN3  .OR. 
OMEGA (ICMD) /AERROR (ICMD) .LT.O.  )  THEN 
IP2END  =  0 
ICNT  =  0 

TBURNA(ICMD)  =  -OMEGA(ICMD) /AACCEL (ICMD, IVPFLN) 

DTSAMP  =  ABS (TBURNA( ICMD) ) 

ITHRES  =  1 
IVPFL  =  IVPFLN 

TP3END  =  T  +  DTSAMP  +  TLAGA  +  TRDNA 
END  IF 

ELSEIF  (  T.GE.TP3END  )  THEN 

C  CORRECTION  COMPLETE  FOR  Ith  AXIS 

TP3END  =  1000. 

DELANG  =  0. 

ICMD  =  0 

END  IF 
ENDIF 

DEFINE  ACS  LEVEL  AND  VALVE  PAIR  CONFIGURATION  BASED  ON 
ACCELERATION  TABLE  INDEX  USED 

IF  (  IVPFL.EQ.4  )  THEN 
ACSLEV  =  2. 

ANVP  =  2 . 

ELSEIF  (  IVPFL. EO. 3  )  THEN 
ACSLEV  =  1. 

ANVP  =  2 . 

ELSEIF  (  IVPFL. EQ. 2  )  THEN 
ACSLEV  =  2. 

ANVP  =  1 . 

ELSE 

ACSLEV  =  1. 

ANVP  =  1 . 

ENDIF 
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C  UPDATE  ACS  BURl'J  COMMAi-JDS 

TRATON  =  TBURNA(l) 

TPATON  =  TBURNA(2) 

TYATON  =  TBURNAO) 

C  CALCULATE  NEXT  TIME  TO  CALL 

TMAUTO  =  T  +  DTMCU  -  EPSL 
endif 

RETURN 

END 
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B.2.22  Uumcguid.for 

c - 

SUBROUTINE  MCGUID (T, TI2M, VG, URREL, MASS, IDIST, MIDBRN, MAGR, MAGV, SP, 
SQ, SR, PITER, YAWER, FLIP, IVCS, ICMD, IDMEAS, IDPASS, 
IDROP, IMCEND, IBURND, IBURNM, VGM, ADISTT, ROLLER, 
TMGUID) 


SUBROUTINE  NAME  :  MCGUID 


AUTHOR  :  R.  RHYNE 

FUNCTION  :  DEFINES  ROLL  ERROR,  SEQUENCES  MIDCOURSE 

EVENTS,  AND  ENABLES  MIDCOURSE  DIVERTS 

CALLED  FROM  :  FORTRAN  MAIN 


SUBROUTINES  CALLED  :  NONE 


INPUTS  :  T,TI2M,VG, URREL, MASS, IDIST, MIDBRN, MAGR, 

MAGV, SP, SQ, SR, PITER, YAWER, FLIP, ICMD 


OUTPUTS 


IDMEAS, IDPASS, IMCEND, IBURND, IBURNM, VGM, 
ADISTT, ROLLER, TMGUID 


BOTH 


IDROP 


UPDATES 


B. 

R. 

HILL  / 
RHYNE 

-  CR 

# 

081 

R. 

RHYNE 

~  CR 

# 

083 

R. 

RHYNE 

-  CR 

# 

084 

R. 

RHYNE 

-  CR 

# 

087 

R. 

RHYNE 

-  CR 

# 

090 

B. 

HILL 

-  CR 

# 

093 

IMPLICIT  REAL  (A-H) 
IMPLICIT  REAL  (0-Z) 


CHARACTER* 12 8 
REAL  TI2M(9) 
REAL  MASS 
REAL  VGM (3) 
REAL  VGP(3) 
REAL  RATE (6) 
INTEGER 
INTEGER 


MESSAGE 
,  VG(3) 

,  MAGR 

,  ADISTT (4, 3) 
,  VGPM(3) 

,  TRGSIG(4) 
I3EQ(4) 
BCKGRD 


,  URREL (3) 

,  MAGV 
,  OMEGAO(3) 

,  ACQRNG(4,4) 

FLIP  , 


SEKTYP 


C  LOCAL  COMMON  USED  FOR  CONSTANTS  AND  INITIALIZATION  FLAG 


SAVE  IMGUin 


C  COMMON  "RMGUID"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RMGUID  /  ISEQ  ,  TVCOMP  ,  OMEGAO  ,  IMIDB2  ,  TMIDB2  , 
ISK30N 


*  DATA  INITIALIZATION 
$  INCLUDE  (  ' ''  /  INCLUDE/  SSDATA4  6  .  DAT  ' ) 
$  INCLUDE  ( '  -'/ INCLUDE/ SSDATA4  8  .DAT' ) 
$  INCLUDE {'^/ INCLUDE/ SSDATA5  0 . DAT ' ) 
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$ INCLUDE INCLUDE / SSDATA5  5 . DAT ' ) 

$  INCLUDE  ( '  '•/INCLUDE /SSDATA60  .DAT  ' ) 

$  INCLUDE  ( '  '•/ INCLUDE/ SSDATA61  .DAT  ' ) 

$INCLUDE  (  ' ''  /INCLUDE/SSDATA62  .  DAT  ' ) 

$INCLUDE ( ' ^/INCLUDE/SSDATAOl .DAT' ) 

$INCLUDE( '  ''/INCLUDE/S3DATA04  .DAT') 

$ INCLUDE ( ' " / INCLUDE / SSDATA05 . DAT ' ) 

$  INCLUDE  ( '  -^  /  INCLUDE /SSDATAO  9  .DAT  ' ) 

$INCLUDE  ( '  ''/INCLUDE/SSDATA12  .DAT  ' ) 

$  INCLUDE  { '  ''/INCLUDE/SSDATA13  .DAT ' ) 

$  INCLUDE  {  '  -'/ INCLUDE /SSDATAl  7  .DAT' ) 

DATA  IMGUID  /  1  / 

IF  {  IMGUID  .EQ.  1  )  THEN 
IMGUID  =  0 

IF  (  SEKTYP.EQ.2  )  THEN 
TSIG  =  TRGSIG(ITRGSG) 

TSGACQ  =  TSIG 

RAQREF  =  ACQRNG(BCKGRD, ITRGSG) 

RNGAQ  =  SQRT ( (TSGACQ/TSIG) * ( 6 . 0/SNRACQ) * 

(SORT ( 1 . /RATE ( 1 )))) *RAQREF 

ELSE  IF  (  SEKTyP.EQ.3  )  THEN 
RNGAQ  =  AC0R3 
ELSE 

RNGAQ  =  RNGACQ 
END  IF 
END  IF 

C  GET  VG  IN  BODY  FRAME 

VGM(l)  =  TI2M(1) *VG(1)  ^  TI2M(4) *VG(2)  +  TI2M (7) *VG (3) 

VGM(2)  =  TI2M(2) *VG(1)  +  TI2M (5) *VG (2)  +  TI2M(8) *VG(3) 

VGM(3)  =  TI2M(3) *VG(1)  +  TI2M(6) *VG (2)  +  TI2M(9) *VG (3) 

C  CALCULATE  ROLL  ERROR  IF  KV  REORIENTATION  AND  UPLINK  HAVE  OCCURRED 

IF  (  FLIP.EQ.O  .AND.  T.GE.TUPLKl  .AND.  IMCEND.EQ.O  )  THEN 

VGDLOS  =  URREL(l) *VG(1)  +  URREL (2) *VG (2 )  +  URREL ( 3) *VG (3) 

C  DETERMINE  PERPENDICULAR  COMPONENT  OF  VG 

VGP(l)  =  VG(1)  -  VGDLOS*URREL(l) 

VGP(2)  =  VG(2)  -  VGDLOS*URREL(2) 

VGP(3)  =  VG(3)  -  VGDLOS*URREL{3) 

C  GET  VGP  IN  BODY  FRAME 

VGPM(l)  =  TI2M(1) *VGP (1)  +  TI2M(4) *VGP (2)  +  TI2M (7) *VGP (3) 

VGPM{2)  =  TI2M(2) *VGP (1)  +  TI2M(5) *VGP (2)  +  TI2M(8) *VGP (3) 

VGPM(3)  =  TI2M(3) *VGP (1)  +  TI2M(6) *VGP (2)  +  TI2M ( 9) *VGP U) 

IF  (  VGPM(3) .NE.O .0  )  THEN 

RERR  =  -ATAN2  (VGPM(2)  ,  VGPM{3)' ) 

ELSE 

PI02  =  PI/2. 

RERR  =  -SIGN(PI02,X) 

ENDIF 

C  ESTIMATE  REQUIRED  DIVERT  DURATION 

ACM  =  FLATM/MASS 
TBURNY  =  ABS(VGPM(2) /ACM) 
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TBURNZ  =  ABS{VGPM(3) /ACM) 

TBURN  =  AMAXl (TBURNY, TBURNZ) 

BYPASS  MAJOR  ROLL  CORRECTION  IF  BURN  TIME  ALONG  EITHER 
AXIS  IS  BELOW  VeS  BURN  THRESHOLD 

IF  (  TBURN. LT.TCMINV  .AND.  ICMD.EQ.O  )  THEN 
ROLLER  =  0. 

ives  =  0 

ELSE  IF  (  ABS (TBURNY) .LT.TCMINV  .AND.  ICMD.EQ.O  )  THEN 
ROLLER  =  0. 

IF  (  VGPM(3)  .CT.  0.  )  THEN 
IVeS  =  4 
ELSE 

ives  =  2 

END  IF 

ELSE  IF  (  ABS (TBURNZ) .LT.TCMINV  .AND.  ICMD.EQ.O  )  THEN 
ROLLER  =  0. 

IF  (  VGPM(2)  .GT.  0.  )  THEN 
ives  =  3 
ELSE 

ives  -  1 

END  IF 


DEFINE  ROLL  ERROR  TO  ALIGN  VGPM  WITH  NEAREST  VCS  THRUSTER 


ELSE  IF  (  ICMD  .EQ.  0 
IF  (  ABS(RERR)  . LE 
ROLLER  =  RERR 
IVeS  =  4 
ELSE  IF  (  RERR 


)  THEN 
PI/4. 


)  THEN 


ROLLER  =  PI 


.LE.  -3.*PI/4.  )  THEN 
+  RERR 


ives 

ELSE  IF 


=  2 
RERR 


.GE.  3.*PI/4.  )  THEN 


ROLLER  =  RERR  -  PI 


ives 

ELSE  IF 


=  2 

RERR. 


LT.3.*PI/4.  .AND.  RERR. GT .PI/4 .  )  THEN 


ROLLER  =  RERR  -  PI/2. 

ives  =  1 

ELSE 

ROLLER  =  RERR  +  PI/2. 
IVeS  =  3 
END  IF 


IF  ATTITUDE  CORRECTION  IN  PROGRESS,  USE  SAME 
ROLL  ERROR  CALCULATION 

ELSE 

IF  (  ives  .EQ.  1  )  THEN 
ROLLER  =  RERR  -  PI/2. 

ELSE  IF  (  ives  .EQ.  2  )  THEN 
IF  (  RERR  .LT.  0.  )  THEN 
ROLLER  =  PI  +  RERR 
ELSE 

ROLLER  =  RERR  -  PI 
END  IF 

ELSE  IF  (  ives  .EQ.  3  )  THEN 
ROLLER  =  RERR  +  PI/2. 

ELSE 

ROLLER  =  RERR 
END  IF 
END  IF 


ELSE 
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C  ZERO  ROLL  ERROR  IF  PITCHOVER  AND  FIRST  UPLINK  HAVE  NOT  OCCURRED 

ROLLER  =  0. 


END  IF 


IF  (  IDMEAS.EQ.O  .AND.  ICMD.EQ.O  .AND.  ABS (PITER) . LE .CATHL 
.AND.  ABS(YAWER) .LE.CAPSL  .AND.  (IGIT.EQ.O  .OR. 

(IGIT.EQ.l  .AND.  T.GE.TDROP))  )  THEN 

C  ENTER  DISTURBANCE  MEASUREMENT  MODE 


10 


WRITE (MESSAGE, 10)  T 
CALL  OUTMES (MESSAGE) 

FORMAT (IX, El 6.9,  '  KV  PITCHOVER  COMPLETE  -  BEGIN', 

'  DISTURBANCE  MEASUREMENT') 


IDMEAS  =  2 
END  IF 


IF  (  IDMEAS. EQ. 2  .AND.  ABS (SP) . LE .CRPHL  .AND.  ABS (SQ) . LE .CRTH 
.AND.  ABS(SR) .LE.CRPS  .AND.  ICMD.EQ.O  )  THEN 

IF  (  IDPASS  .EQ.  0  )  THEN 

C  DEFINE  VeS  DISTURBANCE  SEQUENCE 

IF  (  ABS(VGM(2))  .GE.  ABS(VGM(3))  )  THEN 
INDEXY  =  1 
INDEXZ  =  3 
ELSE 

INDEXY  =  3 
INDEXZ  =  1 
ENDIF 

IF  (  VGM(2)  .GE.  0.  )  THEN 
ISEQ( INDEXY)  =  3 
ISEQ(INDEXY+1)  =  1 
ELSE 

ISEQ( INDEXY)  =  1 
ISEQ(INDEXY+1)  =  3 
ENDIF 

IF  (  VGM(3)  .GE.  0.  )  THEN 
ISEQ (INDEXZ)  =  4 
ISEQ(INDEXZ-H)  =  2 
ELSE 

ISEQ (INDEXZ)  =  2 
ISEQ(INDEXZ+1)  =  4 
ENDIF 
IDPASS  =  1 
ENDIF 

IF  (  IBURND  .EQ.  0  )  THEN 

DROP  BOOST  ADAPTER  AND  NOSE  FAIRING  PRIOR  TO  FIRST 
DISTURBANCE  BURN  -  IF  EVENT  DRIVEN  LOGIC,  SCHEDULE 
SEPARATION  HERE  -  OTHERWISE,  SEPARATION  WILL  OCCUR 
AT  T=TDROP  IN  f-lAIN  ROUTINE 

IF  (  IDROP.EO.O  .AND.  IGIT.EQ.O  )  THEN 
IDROP  =  1 
ELSE 

C  DEFINE  Ith  DISTURBANCE  BURN 
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IBURND  =  1 
IBURNM  =  0 

TVeOMP  =  T  +  TLAGV  +  TBURND  +  TRDNV  +  TIWAIT 
IveS  =  ISEQ(IDPASS) 

OMEGAO(l)  =  SP 
OMEGAO(2)  =  SQ 
OMEGAOO)  =  SR 
END  IF 

ELSE  IF  (  T  .GT.  TVCOMP  )  THEN 

C  COMPUTE  ANGULAR  ACCEL  INDUCED  BY  PREVIOUS  DISTURBANCE  BURN 

IBURND  =  0 

ADISTT(ISEQ(IDPASS) ,1)  =  (SP  -  OMEGAO (1) ) /TBURND 
ADISTT(ISEQ(IDPASS) ,2)  =  (SQ  -  OMEGAO (2) ) /TBURND 
ADISTT(ISEQ(IDPASS) ,3)  =  (SR  -  OMEGAO (3) ) /TBURND 
IDPASS  =  IDPASS  +  1 
TVCOMP  =  1000. 

IF  (  IDPASS  .GT.  4  )  THEN 
IDMEAS  =  1 
WRITE (MESSAGE, 15)  T 
CALL  OUTMES (MESSAGE) 

15  FORMAT (IX, El 6. 9, '  DISTURBANCE  MEASUREMENT  COMPLETE 

*  ORIENT  KV  TO  LOS') 

END  IF 
END  IF 
ENDIF 

ENABLE  SEEKER  AFTER  PITCHOVER  AND  DISTURBANCE 
MEASUREMENT  COMPLETED 

IF  (  ABS (PITER) .LE.CATH  .AND.  ABS (YAWER) . LE . CAPS 
.AND.  ABS(SQ) .LE.CRTH  .AND.  ABS (SR) . LE .CRPS 
.AND.  FLIP.EQ.l  .AND.  IDMEAS. EQ.l  )  THEN 

ENABLE  SEEKER  (TYPES  0,1, &2)  IF  EVENT  DRIVEN  LOGIC  - 
OTHERWISE  WILL  BE  ENABLED  BY  MAIN  ROUTINE  AT  SECOND 
STAGE  SEPARATION  -  SEEKER  TYPE  3  HANDLED  BELOW  - 
TYPE  3  ENABLED  BY  MAIN  ROUTINE  AT  T=TSK30N  IF  EVENT 
LOGIC  NOT  USED 

FLIP  =  0 

WRITE (MESSAGE, 20)  T 
CALL  OUTMES (MESSAGE) 

20  FORMAT (IX, El 6. 9,  '  KV  ORIENTATION  COMPLETE') 

ENDIF 

IF  (  SEKTYP.EQ.3  .AND.  IGIT.EQ.O  .AND.  MAGR . LE . ACQR3 

.AND.  ISK3ON.EQ.0  )  THEN 

ISK30N  =  1 

WRITE (MESSAGE, 30)  T 

CALL  OUTMES (MESSAGE) 

30  FORMAT (IX, El 6. 9,  '  SEEKER  3  ENABLED') 

ENDIF 

C  DEFINE  THREE  MIDCOURSE  DIVERTS 

IF  (  ABS (ROLLER) .LE.CAPH  .AND.  ABS (SP) . LE .CRPH 
.AND.  ICMD.EQ.O  .AND.  T.GT.TUPLKl  )  THEN 
DELMID  =  (  MAGR  -  RNGAQ  ) /MAGV 
IF  (  ICMD.EQ.O  .AND.  MIDBRN.EQ.O  )  THEN 
IBURNM  =  0 
IMIDB2  =  1 
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ELSE  IF  {  IDIST.EQ.O  .AND.  MIDBRN.EQ.l  .AND.  IMIDB2.EQ.1  )  THEN 
TMIDB2  =  T  +  0.5*DELMID 
IMIDB2  =  0 

ELSE  IF  (  T.GE.TMIDB2  .AND.  MIDBRN.EQ.l  )  THEN 
IBURNM  =  0 

ELSE  IF  {  IDIST.EQ.O  .AND.  MIDBRN.EQ.2  )  THEN 
TMAX  =  TBURN  +  TBWAIT 
IF  (  DELMID  .LE.  TMAX+DTMCU  )  THEN 
IBURNM  =  0 
ROLLER  =  0. 

IMCEND  =  1 
ENDIF 

END  IF 

ENDIF 

C  COMPUTE  TIME  OF  NEXT  CALL 

TMGUID  =  T  +  DTMCU  -  EPSL 

RETURN 

END 
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B.2.23  Uumissil.for 

c - 

SUBROUTINE  MISSIL (T, CIM, MASS, 

FXACS, FXVCS, FYACS, FYVCS, 

FZACS,FZVCS, 

X, Y, Z,NCLEAR,UD,VD,WD, 

GB,  GR,  MGR,  FX,  FY,  FZ,  XDD,  YDD,  ZDD,  MXYZDD) 


SUBROUTINE  NAME  ;  MISSIL 

AUTHOR (S)  :  D.  C.  FOREMAN,  A.  P.  BUKLEY 

FUNCTION  :  COMPUTES  THE  ROTATIONAL  AND  TRANSLATIONAL 

MISSILE  ACCELERATIONS 

CALLED  FROM  :  FORTRAN  MAIN 

SUBROUTINES  CALLED  :  FVDOT,FV2BXI 

INPUTS  :  T,QUAT,CIM,P,Q,R, IXX, lYY, IZZ,MASS,FXA, 

FXT, FRCX, FXACS, FXVCS, FYA, FYT, FRCY, FYACS, 
FYVeS, FZA, FZT, FRCZ, FZACS, FZVCS, MXA, MXT, 
MRCX, MXACS , MXVCS , MYA, MYT , MRCY, MYACS , MYVCS , 
MZA,MZT,MRCZ,MZACS,MZVCS,X, Y,  Z,XD,  YD,  ZD 

OUTPUTS  :  UD,VD,WD,PD,QD,RD,GB,GR,MGR,MX,MY,MZ,FX,FY, 

FZ, XDD,  YDD, ZDD, MXYZDD, U, V, W, QUATD, PHI, THT, 
PSI 

BOTH  :  NCLEAR 

UPDATES  :  D.  SISSOM  -  CR  #  Oil 

T.  THORNTON  -  CR  #  012 

T.  THORNTON  -  CR  #  018 

B.  HILL  -  CR  #  030 

T.  THORNTON  -  CR  #  031 

T.  THORNTON  -  CR  #  033 

T.  THORNTON  -  CR  #  035 

T.  THORNTON  -  CR  #  037 

T.  THORNTON  -  CR  #  049 

T.  THORNTON  -  CR  #  050 

D.  SMITH  -  CR  #  059 

D.  SMITH  -  CR  #  060 

B.  HILL  -  CR  #  062 

D.  SMITH  -  CR  #  076 

R.  RHYNE  -  CR  #  079 

B.  HILL  /  -  CR  #  081 

R.  RHYNE 

R.  RHYNC  -  CR  #  087 

B.  HILL  -  CR  #  093 


IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (0-Z) 

DOUBLE  PRECISION  CIM(9)  ,  CMT(9)  ,  GB(3) 

DOUBLE  PRECISION  GR(3)  ,  MASS  ,  MGR 

DOUBLE  PRECISION  MXYZ 

DOUBLE  PRECISION  MXYZDD 

DOUBLE  PRECISION  UXYZ(3) 
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DOUBLE  PRECISION  UXY2DD(3)  ,  XYZLCH(3) 

C  LOCAL  COMMON  USED  FOR  CONSTANTS,  LOCAL  VARIABLES  AND 
C  INITIALIZATION  FLAG 

SAVE  IMISL 

C  C0Mt40N  "RMISSL"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RMISSL  /  XYZLCH 

*  DATA  INITIALIZATION 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA39  .DAT' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA63  -  DAT' ) 

SINCLUDE  ( '''/INCLUDE/SSDATA28  .DAT') 

C  COMPUTE  MISSILE  LAUNCH  POSITION  IN  INERTIAL  FRAME 

CMI(l)  =  CIM(l) 

CMI{2)  =  CIM{4) 

CMI(3)  =  CIM{7) 

CMI(4)  =  CIM(2) 

CMI{5)  =  CIM(5) 

CMI(6)  =  CIM(8) 

CMI(7)  =  CIM(3) 

CMI(8)  =  CIM(6) 

CMI(9)  -  CIM(O) 


C  DETERMINE  LOCAL  GRAVITY  VECTOR 

MXYZ  =  DSQRT  (  X**2  +  Y**2  +  Z**2  ) 

MGR  =  GMU  /  MXYZ*-"- 

IF  (  MXYZ.GT.O.ODO  )  THEN 
UXYZ(l)  =  X  /  MXYZ 
UXYZ(2)  =  Y  /  MXYZ 
UXYZ{3)  =  Z  /  MXYZ 
ELSE 

UXYZ(l)  =  O.ODO 
UXYZ(2)  =  O.ODO 
UXYZ{3)  =  O.ODO 
END  IF 

C  CALCULATE  GRAVITY  VECTOR  IN  INERTIAL  AND  BODY  FRAMES 

GR(1)  =  -  MGR*UXYZ(1) 

GR(2)  =  -  MGR*UXYZ(2) 

GR(3)  =  -  MGR*UXYZ{3) 

GB(1)  =CIMU)*GR(1)  +  CIM(4)  *GR(2)  -i  CIM(7)*GR(3) 

GB{2)  =  CIM(2)*GR(1)  +  CIM(5) *GR{2)  +  CIM (8) *GR ( 3) 
GB(3)  =  CIM(3) *GR(1)  +  CIM(6) *GR(2)  +  CIM ( 9) *GR (3) 

C  CALCULATE  TOTAL  FOIXES  AND  MOMENTS 

FX  =  FXACS  +  FXVCS 

FY  =  FYACS  +  FYVeS 

FZ  =  FZACS  +  FZVeS 

C  MISSILE  CLEARED  THE  LAUNCHER 

IF  (  NCLEAR.EQ.l  )  THEN 
UD  =  FX/MASS  +  GB(1) 
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VD  =  FY/MASS  +  GB(2) 

WD  =  FZ/MASS  +  G3(3) 

END  IF 

C  TRANSFORM  BODY  ACCELERATIONS  TO  INERTIAL  FRAME 


XDD  =  CMI(1)*UD  +  CMI(4)*VD  +  CMI(7)*WD 
YDD  =  CMI(2)*UD  +  CMI(S)*VD  +  CMI(8)*WD 
ZDD  =  CMI(3)*UD  +  CMI(6)*VD  +  CMI(9)*WD 


MXYZDD  =  DSQRT  (  XDD* *2  + 
IF  (  MXYZDD.GT.O.ODO  )  THEN 
UXYZDD(l)  =  XDD  /  MXYZDD 
UXYZDD(2)  =  YDD  /  MXYZDD 
UXYZDDO)  =  ZDD  /  MXYZDD 
ELSE 

UXYZDD(l)  =  O.ODO 
UXYZDD(2)  =  O.ODO 
UXYZDD(3)  =  O.ODO 
ENDIF 


YDD**2  +  ZDD**2  ) 


RETURN 

END 
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B.2.24  Uuniissl2.for 

c - 

SUBROUTINE  MISSIL2 (T, QUAT, CIM, P, Q, R, IXX, lYY, IZZ, 
MXACS, MXVCS, MYACS, MYVCS, MZACS, 
MZVeS,  XD,  YD, ZD, NCLEAR, PD, QD,  RD, 
MX,MY,MZ,U,V,W,QUATD,PHI,THT,PSI) 


SUBROUTINE  NAME  : 
AUTHOR  (S',  : 
FUNCTION  : 

CALLED  FROM  : 


MISSIL 

D.  C.  FOREMAN,  A..  P.  BUKLEY 

COMPUTES  THE  ROTATIONAL  AND  TRANSLATIONAL 
MISSILE  ACCELERATIONS 

FORTRAN  MAIN 


SUBROUTINES  CALLED  :  FVDOT,FV2BXI 

INPUTS  :  T, QUAT, CIM,P,Q,R, IXX, lYY, IZZ, 

MXA, 

MXACS, MXVCS, MYACS, MYVCS, 
MZACS, MZVCS,XD, YD, ZD 

OUTPUTS  :  PD,QD,RD,MX,MY,MZ, 

U,V,W,QUATD,PHI,THT, 

PSI 


BOTH  : 

NCLEAR 

UPDATES  : 

D. 

SISSOM 

- 

CR 

# 

Oil 

T, 

THORNTON 

- 

CR 

# 

012 

T , 

THORNTON 

- 

CR 

# 

018 

B. 

HILL 

- 

CR 

# 

030 

T. 

THORNTON 

- 

CR 

# 

031 

T. 

THORNTON 

- 

CR 

# 

033 

T. 

THORNTON 

- 

CR 

# 

035 

T. 

THORNTON 

- 

CR 

# 

037 

T. 

THORNTON 

- 

CR 

# 

049 

T. 

THORNTON 

- 

CR 

if 

050 

D. 

SMITH 

- 

CR 

# 

059 

D. 

SMITH 

- 

CR 

# 

060 

B. 

HILL 

- 

CR 

# 

062 

D. 

SMITH 

- 

CR 

# 

076 

R. 

RHYNE 

- 

CR 

# 

079 

B., 

HILL  / 

- 

CR 

# 

081 

R. 

RHYNE 

R. 

RHYNE 

- 

CR 

# 

087 

B. 

HILL 

- 

CR 

# 

093 

IMPLICIT  REAL 

(A-H) 

IMPLICIT  REAL 

(0-Z) 

REAL 

CIM{9) 

,  CMI{9) 

REAL 

TYY 

,  lYY 

REAL 

IZZ 

REAL 

MX 

,  MXACS 

REAL 

MXVCS 

REAL 

MY 

REAL 

MYACS 

,  MYVCS 
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REAL  MZ  ,  MZACS 

REAL  MZVeS  ,  PQR(3) 

REAL  QUAT(4)  ,  QUATD(4) 

REAL  XYZLCHO) 

LOCAL  COMMON  USED  FOR  CONSTANTS,  LOCAL  VARIABLES  AND 

INITIALIZATION  FLAG 

SAVE  IMISL 

C  COMMON  "RMISSL"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RMISSL  /  XYZLCH 

*  DATA  INITIALIZATION 
$  INCLUDE  ( ' INCLUDE  /  SSD  ATA3  9.  DAT  • ) 

SINCLUDE  ( '  ''/INCLUDE/SSDATA63  .DAT ' ) 

SINCLUDE  ( ' ''/ INCLUDE /SSDATA2 8  .DAT  • ) 

DATA  IMISL  /  1  / 

IF  (IMISL  .EQ.  1)  THEN 

IMISL  =  0 

C  COMPUTE  MISSILE  LAUNCH  POSITION  IN  INERTIAL  FRAME 

CMI(l)  =  CIM(l) 

CMI{2)  =  CIM(4) 

CKJ(3)  =  CIM(7) 

CMI{4)  «  CIM(2) 

CMI(5)  =  CIM(5) 

CMI(6)  =  CIM(8) 

CMI(7)  =  CIM(3) 

CMI(8)  =  CIM{6) 

CMI(9)  ■=  CIM(9) 

END  IF 

C  CALCULATE  TOTAL  FORCES  AND  MOMENTS 

MX  =  MXACS  +  MXVCS 

MY  =  MYACS  +  MYVeS 

MZ  =  MZACS  +  MZVeS 

C  MIS'.SILE  CLEARED  THE  LAUNCHER 

IF  {  NCLEAR.EQ.l  )  THEN 

PD  =  MX/IXX  +  Q*R* ( (lYY-IZZ) /IXX) 

QD  =  MY/IYY  +  R*P* ( (IZZ-IXX) /lYY) 

RD  =  MZ/IZZ  +  P*Q* ( (IXX-IYY) /IZZ) 

END  IF 

C  COMPUTE  QUATERNION  DERIVATIVES 

PQRd)  =  P 

PQR(2)  =  Q 

PQR(3)  =  R 

TMPl  =0.0 

CALL  FVD0T(PQR,TMP1,QUAT,QUATD) 

C  COMPUTE  BODY-TO-INERTIAL  TRANSFORMATION  MATRIX 
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CALL  FV2BXI (QUAT,TMP1,CMI) 

CIM(l)  =  CMI (1) 

CIM(2)  =  CMI (4) 

CIM(3)  =  CMI (7) 

CIM(4)  =  CMI (2) 

CIM{5)  =  CMI(5) 

CIM(6)  =  CMI (8) 

CIM(7)  =  CMI(3) 

CIM(8)  =  CMI (6) 

CIM(9)  =  CMI (9) 

C  COMPUTE  EULER  ANGLES 

PHI  =  ATAN2 (CIM(8) ,CIM(9) ) 

THT  =  -ASIN  (CIM(7)) 

PSI  =  ATAN2 (CIM(4) ,CIM(1) ) 

C  TRANSFORM  INERTIAL  VELOCITY  TO  BODY  FRAME 

U  =  CIM{1)*XD  +  CIM(4)*YD  +  CIM(7)*ZD 

V  =  CIM(2)*XD  +  CIM(5)*YD  +  CIM(8)*ZD 

W  =  CIM(3)*XD  +  CIM(6)*YD  +  CIM(9)*ZD 

RETURN 

END 
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B.2.25  Uummk.for 

c - 

SUBROUTINE  MMK (A, NA, B, NB, C, NC, RM) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 
FUNCTION  : 


MMK 

J.  SHEEHAN 

GENERATES  A  DIRECTION  COSINE  MATRIX 


BY  ROTATING 

IN  ORDER: 

1) 

ANGLE 

C 

ABOUT 

THE 

NC 

AXIS 

2) 

ANGLE 

B 

ABOUT 

THE 

NB 

AXIS 

3) 

ANGLE 

A 

ABOUT 

THE 

NA 

AXIS 

CALLED  FROM  : 
SUBROUTINES  CALLED 
INPUTS  ; 

OUTPUTS  ; 

UPDATES  : 


UTILITY  SUBROUTINE 
ROTMX,  MMLXY 
A,NA,B,NB,C,NC 
RM 

D.  SMITH  -  CR  #  59 


IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (0-Z) 

C 

DIMENSION  aM(3, 3) ,  BM(3,3),  CM(3,3),  RM(3,3),  T(9) 
C 

CALL  ROTMX (A, NA, AM) 

CALL  ROTMX <B,NB,BM) 

CALL  ROTMX (C,NC, CM) 

C 

CALL  MMLXY (BM, CM, T) 

CALL  MMLXY (AM, T,RM) 

C 

RETURN 

END 
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B.2.26  Uummlxy.for 


SUBROUTINE  MMLXY{X,Y, 

Z) 

SUBROUTINE  NAME 

MMLXY 

AUTHOR (S)  : 

J.  SHEEHAN 

FUNCTION  : 

MULTIPLY  TWO  3X3 

MATRICES 

CALLED  FROM  : 

UTILITY  SUBROUTINE 

SUBROUTINES  CALLED  : 

NONE 

INPUTS  : 

X,  Y 

OUTPUTS  : 

Z 

UPDATES  : 

D.  SMITH  -  CR 

#  59 

IMPLICIT  DOUBLE  PRECISION  (A-H) 
IMPLICIT  DOUBLE  PRECISION  (0-Z) 


DIMENSION  X (3,3) ,  Y(3,3),  Z(3,3) 


Z(I,J)  =  X(I,l)*y(l,J)  +  X(I,2)  *y  (2,  J) 


+  X(I,3)  *Y(3,  J) 


C 


Z(l,l)  =  X(1,1)*Y(1,1)  +  X{1,2)  *Y{2,1) 
Z(2,l)  =  X(2,1)*Y(1,1)  +  X(2,2)  *Y(2,1) 
Z(3,l)  =  X(3, 1)  *Y(1, 1)  +  X(3,2)  *Y(2, 1) 
Z(l,2)  =  X(l,l) *Y{1,2)  +  X(l,2) *Y{2,2) 
Z(2,2)  =  X(2,1)*Y(1,2)  +  X{2,2) *Y(2,2) 
Z(3,2)  =  X(3,1)*Y(1,2)  +  X(3,2) *Y(2,2) 
Z(l,3)  =  X(1,1)*Y{1,3)  +  X(l,2)  *Y(2,3) 
Z(2,3)  =  X(2, 1) *Y(1,3)  +  X(2,2) *Y(2,3) 
Z(3,3)  =  X(3, 1) *Y{1, 3)  +  X(3,2) *Y(2,3) 


+  X(1,3)*Y(3,1) 
+  X(2,3) *Y(3, 1) 
+  X(3,3)  *Y(3, 1) 
+  X(l,3) *Y(3,2) 
+  X{2,3)  *Y(3,2) 
+  X(3,3) *Y(3,2) 
+  X{1,3)*Y{3,3) 
+  X(2, 3) *Y (3, 3) 
+  X{3, 3) *Y(3, 3) 


RETURN 

END 
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B.2.27  Uunavig.for 

c - 

SUBROUTINE  NAVIG (T, MASS, DELPHI, DELTHT,  DELPSI,  DELU, DELV, DELW, GR, 
QSl, CIE, SP, SQ, SR, SUD, SVD, SWD, VMIR, RMIR, TI2M, 
SPHI,  STHT,  SPSI, SU, SV, SW, AT, VMI, RMI) 


SUBROUTINE  NAME  :  NAVIG 

AUTHOR (S)  :  B.  HILL 

FUNCTION  :  COMPUTES  THE  QUATERNIONS  AND  TRANSFORMATION 

MATRICES  USING  DELTA  ANGLES  SENSED  BY  THE 
GYRO.  COMPUTES  THE  POSITION  AND  VELOCITY  IN 
INERTIAL  AND  EARTH-CENTERED  FRAMES. 

COMPUTES  SENSED  BODY  RATES,  EULER  ANGLES  AND 
THE  GRAVITY-COMPENSATED  ACCELERATION. 

CALLED  FROM  :  FORTRAN  MAIN 

SUBROUTINES  CALLED  ;  NONE 

INPUTS  :  T, MASS, DELPHI, DELTHT, DELPSI, DELU, DELV, DELW, 

GR,CIE 

OUTPUTS  :  QSl, TI2M, SPHI, STHT, SPSI, SU,SV,SW, AT, VMI, RMI 

BOTH  :  SP,SQ, SR, SUD, SVD, SWD, VMIR, RMIR 

UPDATES  :  T.  THORNTON  -  CR  #  0i6 

B.  HILL  -  CR  #  019 

B.  HILL  -  CR  #  022 

B.  HILL  -  CR  #  030 

T.  THORNTON  -  CR  #  033 

T.  THORNTON  -  CR  #  037 

D.  SMITH  -  CR  #  059 

B.  HILL  -  CR  #  062 

D.  SISSOM  -  CR  #  069 

D.  SMITH  -  CR  #  070 

D.  SMITH  -  CR  #  075 

D.  SMITH  -  CR  #  076 

B.  HILL  /  -  CR  #  081 

R.  RHYNE 

R.  RHYNE  -  CR  #  087 

B.  HILL  -  CR  #  089 

D.  SMITH  -  CR  #  092 

B.  HILL  -  CR  #  093 


IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (0-Z) 

DOUBLE  PRECISION  VMIR(3)  ,  RMIR(3)  ,  VMI (3) 

DOUBLE  PRECISION  RMI (3)  ,  TI2M(9) 

DOUBLE  PRECISION  GR(3)  ,  CIE (9)  ,  AT (3) 

DOUBLE  PRECISION  QSl  (4)  ,  MASS  ,  GRAVG(3)' 

DOUBLE  PRECISION  GRLAST(3) 

LOCAL  COMMON  USED  FOR  LOCAL  VARIABLES  AND 
INITIALIZATION  FLAG 
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SAVE  INAVIG 

C  COMMON  "RNAVIG"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RNAVIG  /  GRLAST  ,  TONAV  ,  MNAV  ,  DTXO  ,  DTYO  , 
DTZO 

DATA  INAVIG  /  1  / 

IF  {  INAVIG. EQ.l  )  THEN 
INAVIG  =  0 

QSIM  =  DSQRT(QS1 (1) **2  +  QS1(2)**2  +  QS1(3)**2  +  QS1(4)**2) 
IF  (  QSIM  .EQ.  0.  )  THEN 

C  COMPUTE  QUATERNION  COMPONENTS 

SITHO  =  DSIN(STHT/2.GD0) 

COTHO  =  DCOS (STHT/2 .ODO) 

SIPSO  =  DSIN(SP3I/2.0D0) 

COPSO  =  DCOS  (SPSI/2. ODO) 

SIPHO  =  DSIN(SPHI/2.0D0) 

COPHO  =  DCOS (SPHI/2. ODO) 

C  CALCULATE  QUATERNIONS 

QS1(4)  =  COPSO*COTHO*COPHO  +  SIPS0*SITH0*SIPH0 

QSKl)  =  COPSO*COTHO*SIPHO  -  SIPSO*SITHO*COPHO 

QS1{2)  =  COPSO*SITHO*COPHO  +  SIPSO*COTHO*SIPHO 

QS1(3)  =  -COPSO*SITHO*SIPHO  +  SIPSO*COTHO*COPHO 

C  COMPUTE  TRANSFORMATION  MATRICES 

D1  =  QS1(4)  *  QS1(4) 

D2  =  QSKl)  *  QSKl) 

D3  =  QSl (2'  *  QSl  (2) 

D4  =  QSK3)  *  QSl  (3) 

D5  =  QSKl)  *  QSl  (2) 

D6  =  QSKl)  *  QSK3) 

D7  =  QSKl)  *  QSK4) 

D8  =  QSK2)  *  QSK3) 

D9  =  QSK2)  *  QSK4) 

D10=  QSK3)  *  QSK4) 

TI2M(1)  =  D1  +  D2  -  D3  -  D4 
TI2M(2)  =  2 .ODO* (D5  -  DIO) 

TI2M(3)  =  2. ODO* (D6  +  D9) 

TI2M(4)  =  2.0D0*(D5  +  DIO) 

TI2M(5)  =  D1  -  D2  +  D3  -  D4 
TI2M(6)  =  2.0D0*(D8  -  D7) 

TI2M{7)  =  2.0D0*(D6  -  D9) 

TI2M(8)  =  2.0D0*(D8  +  D7) 

TI2M(9)  =  D1  -  D2  -  D3  +  D4 

END  IF 
END  IF 

DTDEL  =  T  -  TONAV 
TONAV  =  T 

C  COMPUTE  CORRECTED  INTEGRAL  ANGLES 

DTX  =  0.5D0*DELPHI 
DTY  =  0.5D0*DELTHT 
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DTZ  =  0.5D0*DELPSI 
C  INTERMEDIATE  COMPUTATIONS 

PPO  »  DTX**2  +  DTY**2  +  DTZ**2 

PPl  =  (  PP0*DTX  +  DTY*DTZO  -  DT2*DTY0  )  /  6.0D0 

PP2  =  (  PP0*DTY  +  DTZ*DTXO  -  DTX*DTZ0  )  /  6.0D0 

PP3  =  (  PP0*DTZ  +  DTX*DTY0  -  DTY*DTX0  )  /  6.0D0 

C  SET  PAST  VALUES  OF  CORRECTED  INCREMENTAL  ANGLES  TO  PRESENT 

DTXO  =  DTX 

DTYO  =  DTY 

DTZO  =  DTZ 

C  UPDATE  CURRENT  VALUES  OF  CORRECTED  INCREMENTAL  ANGLE 

DTX  =  DTX  -  PPl 

DTY  =  DTY  -  PP2 

DTZ  =  DTZ  -  PP3 

C  CALCULATE  DELTA  QUATERNIONS 

DUM  =  -0.5D0*PP0 

PQO  =  DUM*QS1(4)  -  DTX*QSi(l)  -  DTY*QS1(2)  -  DTZ*QS1{3) 

PQl  =  DTX*QS1(4)  +DUM*0S1(1)  +DTZ*QS1(2)  -DTY*QS1(3) 

PQ2  =  DTY*QS1(4)  -  DTZ*QS1(1)  +  DUM*QS1(2)  +  DTX*QS1(3) 

PQ3  =  DTZ*QS1(4)  +  DTY*QS1(1)  -  DTX*QS1(2)  +  DUM*QS1(3) 

C  UPDATE  QUATERNIONS 

QS1(4)  =  QS1(4)  +  PQO 

QSl(l)  =  QSl(l)  +  PQl 

QS1(2)  =  QS1<2)  +  PQ2 

QS1(3)  =  QS1{3)  +  PQ3 

C  NORMALIZE  QUATERNIONS 

DQ  l.OdO  +  0.5DO*(1.0DO-QS1(4)**2-QS1(1)**2 

1  -QS1(2) **2-QSl (3) **2) 

QSl(l)  =  QS1(1)*(DQ) 

QSl  (2)  =  QSl (2) * (DQ) 

QSl  (3)  =  QSl (3) * (DQ) 

QSl  (4)  =  QS1(4)*(DQ) 

C  COMPUTE  TRANSFORMATION  MATRICES 

D1  =  QSl (4)  *  QSl (4) 

D2  =  QSl(l)  *  QSl(l) 

D3  =  QSl (2)  *  QSl (2) 

D4  =  QSl (3)  *  QSl (3) 

D5  =  QSl(l)  *  QS1(2) 

D6  =  QSl(l)  *  QS1(3) 

D7  =  QSl(l)  *  QS1(4) 

D8  =  QS1(2)  *  QS1(3) 

D9  =  QS1(2)  *  QS1(4) 

D10=  QSl (3)  *  QSl (4) 

TI2M(1)  =  D1  V  D2  -  D3  -  D4 
TI2M(2)  =  2.OD0*  (D5  -  DIO) 

TI2M(3)  =  2  .ODO*  (D6  +  D9) 

TI2M(4)  =  2.0D0*(D5  +  DIO) 

TI2M(5)  =  D1  -  D2  +  D3  -  D4 
TI2M(6)  =  2. ODO*  (D8  -  D7) 

TI2M(7)  =  2 .ODO*  (D6  -  D9) 
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TI2M(8)  =  2 .ODO*  (D8  +  D7) 
TI2M(9)  =  D1  -  D2  -  D3  +  D4 


C  COMPUTE  SENSED  EULER  ANGLES 

SPHI  =  DATAN2 (TI2M(8) ,TI2M(9) ) 

STHT  =  -DASIN  (TI2M(7)) 

SPSI  =  DATAN2 (TI2M(4) ,TI2M(1) ) 

C  CALCULATE  SENSED  ANGULAR  RATES  AND  ACCELERATIONS  IN  BODY  FRAME 

IF  (  DTDEL.GT.O.ODO  )  THEN 
SP  =  DELPHI/DTDEL 

SQ  =  DELTHT/DTDEL 

SR  =  DELPSI/DTDEL 

SUD  =  DELU/DTDEL 

SVD  =  DELV/DTDEL 

SWD  =  DELW/DTDEL 

ENDIF 

C  TRANSFORM  THE  SENSED  BODY  ACCELERATIONS  TO  THE  INERTIAL  FRAME  ( 

DOES 

C  NOT  INCLUDE  GRAVITY  ) 

C  NOTE  AT  =  (SUD, SVD, SWD)  *  TRANSPOSE [ TM2 I ] 

AT{1)  =  TI2M(1)*SUD  +  TI2M(2)*SVD  +  TI2M(3)*SWD 

AT(2)  =  TI2M(4)*SUD  +  TI2M(5)*SVD  +  TI2M(6)*SWD 

AT(3)  =  TI2M(7)*SUD  +  TI2M(8)*SVD  +  TI2M(9)*SWD 

C  TRANSFORM  THE  SENSED  DELTA  VELOCITIES  INTO  INERTIAL  COORDINATES 

DELXD  =  TI2M(1)*DELU  +  TI2M(2)*DELV  +  TI2M(3)*DELW 

DELYD  =  TI2M{4)*DELU  +  TI2M(5)*DELV  +  TI2M(6)»DELW 

DELZD  =  TI2M(7)*DELU  +  TI2M(8)*DELV  +  TI2M(9)*DELW 

C  DETERMINE  AVERAGE  GRAVITY  VECTOR  OVER  PREVIOUS  INTERVAL 


IF  {  DTDEL.NE.O.ODO  ) 
GRAVG(l)  =  0.5D0*( 
GRAVG(2)  =  0.5DO*{ 
GRAVG(3)  =  0.5D0*  ( 
ELSE 

GRAVG(l)  =  GR(1) 
GRAVG(2)  =  GR(2) 
GRAVG(3)  =  GR{3) 
ENDIF 


THEN 

GRLAST(l) 

GRLAST(2) 

GRLAST(3) 


+  GR(1) 
+  GR(2) 
+  GR(3) 


) 

) 

) 


C  SAVE  GRAVITY  VECTOR  FOR  USE  ON  NEXT  PASS 


GRLAST(l)  =  GR(1) 

GRLAST(2)  =  GR(2) 

GRLAST(3)  =  GR(3) 

C  GRAVITY  COMPENSATE  THE  SENSED  DELTA  VELOCITY  COMPONENTS 

DELXD  =  DELXD  +  DTDEL*GRAVG{1) 

DELYD  =  DELYD  +  DTDEL*GRAVG (2 ) 

DELZD  =  DELZD  +  DTDEL*GRAVG (3) 

C  COMPUTE  SENSED  MISSILE  POSITION  AND  VELOCITY  IN  INERTIAL  FRAME 

RMIR(l)  =  RMIR(l)  +  DTDEL* (VMIR(l)  +  0.5D0*DELXD) 

RMIR(2)  =  RMIR(2)  +  DTDEL* (VMIR (2)  +  0.5D0*DELYD) 

RMIR(3)  =  RMIR(3)  +  DTDEL* (VMIR (3)  +  0.5D0*DELZD) 
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VMIR(l)  =  VMIR(l)  +  DELXD 
VMIR{2)  =  VMIR(2)  +  DELYD 
VMIR(3)  =  VMIR(3)  +  DELZD 

C  TRANSFORM  SENSED  INERTIAL  VELOCITIES  INTO  BODY  FRAME 


SU  =  TI2M(1) *VMIR(1)  +  TI2M(4) *VMIR(2)  +  TI2M(7) *VMIR(3) 

SV  =  TI2M{2) *VMIR(1)  +  TI2M ( 5) *VMIR (2 )  +  TI2M(8) *VMIR{3) 

SW  =  TI2M{3) *VMIR(1)  +  TI2M ( 6) *VMIR (2 )  +  TI2M ( 9) *VMIR (3 ) 

C  TRANSFORM  THE  SENSED  INERTIAL  STATES  INTO  EARTH  COORDINATE  FRAME 


RMI (1) 
RMI (2) 
RMI (3) 


=  CIE (1) *RMIR(1) 
=  CIE (2) *RMIR(1) 
=  CIE (3) *RMIR(1) 


CIE(4) *RMIR(2)  + 
CIE{5) *RMIR(2)  + 
CIE(6) *RMIR{2)  + 


CIE(7) *RMIR(3) 
CIE{8) *RMIR(3) 
CIE{9) *RMIR(3) 


VMI(l)  =  CIE(l) *VMIR(1)  +  CIE(4)*VMIR(2) 
VMI(2)  =  CIE(2) *VMIR(1)  +  CIE (5) *VMIR(2) 
VMI(3)  =  CIE(3) *VMIR(1)  +  CIE (6) *VMIR (2) 


+  CIE(7) *VMIR(3) 
+  CIE(8) *VMIR(3) 
+  CIE(9) *VMIR(3) 


RETURN 

END 
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B.2.28  Uunorm.for 


SUBROUTINE  spNORM(SD, 

MN, ISEED, RDN) 

SUBROUTINE  NAME  : 

NORM 

AUTHOR (S)  : 

D.  F.  SMITH 

FUNCTION  : 

GENERATES  NORMALLY  DISTRIBUTED  RANDOM 
NUMBERS  USING  THE  BOX-MULLER  TRANSFORMATION 

CALLED  FROM 

UTILITY  SUBROUTINE 

SUBROUTINES  CALLED  : 

RANG 

INPUTS  : 

SD,MN 

OUTPUTS  : 

RDN 

BOTH  : 

ISEED 

UPDATES  : 

D.  SMITH  -  CR  # 
R.  RHYNE  -  CR  # 

082 

087 

IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (O-Z) 

INTEGER* 4  I SEED 

REAL  MN 

COMMON  /  NORCOM  /  GSET  ,  I SET 

DATA  ONE  /  l.OeO  / 

DATA  TWO  /  2.0e0  / 

IF  A  SPARE  RANDOM  NUMBER  IS  NOT  AVAILABLE  FROM  THE  PREVIOUS  PASS 
GENERATE  TWO  NEW  ONES 

IF  (  ISET.EQ.O  )  THEN 

GET  TWO  UNIFORM  RANDOM  NUMBERS  WITHIN  THE  SQUARE  EXTENDING 
FROM  -1  TO  1  IN  EACH  DIRECTION 


1  VI  =  TWO*SpRANO  (ISEED),  -  ONE 

V2  =  TWO*spRANO( ISEED)  -  ONE 

SEE  IF  THEY  ARE  WITHIN  THE  UNIT  CIRCLE  .  IF  NOT  ,  TRY  AGAIN  . 

R  =  V1*V1  +  V2*V2 

IF  (  R.GE.ONE  )  GO  TO  1 


PERFOPJ4  BOX-MULLER  TRANSFORI-IATION  TO  GENERATE  TWO  GAUSSIAN 


RANDOM  NUMBERS 
PASS  . 


RETURN  ONE  AND  SAVE  THE  OTHER  FOR  THE  NEXT 


FAC  =  SQRT  (  -TWO*ALOG(R) /R  ) 

GSET  =  FAC*V1 
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RDN  =  MN  +  SD*FAC*V2 

ISET  =  1 

C  USE  GAUSSIAN  RANDOM  NUMBER  CARRIED  OVER  FROM  PREVIOUS  PASS  . 

ELSE  IF  (  ISET.EQ.l  )  THEN 
RDN  =  MN  +  SD*GSET 

ISET  =  0 

END  IF 

RETURN 

END 
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u.z.ZP  Uuobtarg.for 

c - 

SUB^  OUTINE  OBTARG (T, GRTEST, RTEST, VTEST) 


SUBROUTINE  NAME  ;  OBTARG 


AUTHOR (S)  : 

D. 

SISSOM 

FUNCTION  : 

COMPUTES  THE  ( 

ONBOARD  TARGET  ESTIMATES 

CALLED  FROM  : 

FORTRAN  MAIN 

SUBROUTINES  CALLED  : 

NONE 

INPUTS  : 

T, 

GRTEST 

BOTH  : 

RTEST, VTEST 

UPDATES  : 

B. 

F  'LL 

CR 

# 

030 

T. 

THORNTON  - 

CR 

# 

045 

B. 

HILL 

CR 

# 

055 

D. 

SMITH 

CR 

# 

059 

B. 

HILL 

CR 

# 

062 

D. 

SISSOM 

CR 

# 

069 

D. 

SMITH 

CR 

# 

070 

B. 

HILL  / 

CR 

# 

081 

R. 

RHYNE 

R. 

RHYNE 

CR 

# 

087 

D. 

SISSOM 

CR 

091 

B. 

HILL 

CR 

# 

093 

IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECIS" ^N  (0-Z) 


DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 


RTEST (3) 

GRTEST (3),  VTEST (3) 
GRTPST(3)  ,  GRTAOB(3) 

TARPOS(3)  ,  TARVEL(3) 


INTEGER  FIRST2 


C  COMMON  "ROBTRG"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 


COMMON  /  ROBTRG  /  FIRST2,  TL2,  GRTPST 


*  DATA  INITIALIZATION 

SINCLUDE { '^/INCLUDE/SSDATA65.DAT' ) 


IF  (  FIRST2  .EQ.  1  )  THEN 
FIRST2  =  0 
TL2  =  T 

C  INITIALIZE  ESTIMATED  TARGET  STATES 

DO  45  lAXIS  =  1,  3 

RTEST (lAXIS)  =  TARPOS (lAXIS) 
VTEST (lAXIS)  =  TARVEL(IAXIS) 

45  CONTINUE 
ELSE 
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INTEGRATE  TARGET  ACCELERATION  AND  VELOCITY  USING  AVERAGE 
GRAVITY  VECTOR  OVER  LAST  INTERVAL 

TDELT  =  T  -  TL2 
TL2  =  T 
DO  2  I  =  1,3 

GRTAOB(I)  =  0.5D0  *  (  GRTEST(I)  +  GRTPST(I)  ) 

RTEST(I)  =  RTEST(I)  +  VTEST (I) *TDELT  + 
0.5D0*GRTAOB(I) *TDELT*TDELT 
VTEST  (I)  =  VTEST (I)  +  GRTAOB (I) *TDELT 

2  CONTINUE 
END  IF 

C  SAVE  GRAVITY  VECTOR  FOR  USE  ON  NEXT  PASS 

DO  3  I  =  1,3 

GRTPST(I)  =  GRTEST(I) 

3  CONTINUE 

RETURN 

END 
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B.2.30  Uuran.for 


REAL  FUNCTION  RAN(ISEED) 


SUBROUTINE  NAME  : 

RAN 

AUTHOR (S)  : 

D.  F.  SMITH 

FUNCTION  : 

GENERATES  A  UNIFORMLY  DISTRIBUTED  RANDOM 
NUMBER 

CALLED  FROM  : 

UTILITY  SUBROUTINE 

SUBROUTINES  CALLED  ; 

NONE 

INPUTS  : 

NONE 

OUTPUTS  : 

RAN 

BOTH  : 

ISEED 

UPDATES  : 

NONE 

inv,eger*4  iseed 

iseed  =  69069*iseed  +  1 

ran  =  abs (float (iseed) /2147483647 .0) 

RETURN 

END 


367 


on  oo  o  o  o  o  o  o  r>  n  o  o  o  o  o  o  o  o  o  o  o  o  o  o  o  o  o  o  n  o 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


B.2.31  UuranO.for 

c - 

DOUBLE  PRECISION  FUNCTION  RANO(ISEED) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 
FUNCTION  : 


CALLED  FROM  : 
SUBROUTINES  CALLED 
INPUTS  ; 

OUTPUTS  : 

BOTH  ; 

UPDATES  : 


RANG 

D.  F.  SMITH 

GENERATES  A  UNIFORMLY  DISTRIBUTED  RANDOM 
NUMBER  BETWEEN  0  AND  1  USING  THE  SYSTEM 
ROUTINE  RAN(ISEED)  .  THE  BUFFER  IN  COMMON 
BLOCK  RANCOM  IS  INITIALIZED  BY  CALLl.JG 
ROUTINE  RANIT  . 

UTILITY  SUBROUTINE 

RAN 

NONE 

RANG 

ISEED 

NONE 


NOTE  :  IMPLICIT  DOUBLE  PRECISION  IS  NOT  NEEDED  SINCE  THE  OUTPUT 
OF  RAN  IS  SINGLE  PRECISION 

j.rteger*4  iseed 

COMMON  /  RANCOM  /  RMJSEQ(97),  RANLST 

USE  PREVIOUSLY  SAVED  RANDOM  NUMBER  AS  BUFFER  INDEX  AND  MAKE 
LURE  ARRAY  BOUNDS  ARE  NOT  EXCEEDED  . 

J  =  1  +  INT  (  97.0*RANLST  ) 

IF  (  J.LT.l  .OR.  J.GT.97  )  THEN 

CALL  OUTMES ( '  RANDOM  NUMBER  OUT  OF  BOUNDS  IN  RANG ' ) 

END  IF 

RETRIEVE  RANDOM  NUMBER  FROM  BUFFER  FOR  OUTPUT  AND  SAVE  IT  FOR 
USE  AS  AN  INDEX  ON  THE  NEXT  PASS  . 

RAh^LST  =  RANSEQ(J) 

RANG  =  DBLE  (  RANLST  ) 

C  LOAD  A  NEW  RANDOM  NUMBER  IN  THE  SLOT  JUST  VACATED  . 

RANSEQ(J)  =  RAN  (  ISEED  ) 

RETU.RN 

END 
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B.2.32  Uurelat.for 

c - 

SUBROUTINE  RELAT  (RTIC,  VTIC,  X,  Y,  Z,  XD,  YD,  ZD,  Q,  R,  CIM,  CMS,  RRELTR, 
MAGRTR, VRELTR,MGRDTR,MAGLOS, LAMTRU, LAMDXX, 
LAMDTR, LAMSEK, LAMDSK, TGOTR, RRELM, VRELM) 


SUBROUTINE  NAME  :  RELAT 


AUTHOR (S)  ;  T,  THORNTON 

FUNCTION  :  COMPUTES  RELATIVE  RANGE,  RANGE  RATE, 

TIME-TO-GO,LOS  ANGLES  AND  RATES 

CALLED  FROM  :  FORTRAN  MAIN 

SUBROUTINES  CALLED  :  NONE 


INPUTS  : 


RTIC, VTIC, X, Y, Z, XD, YD, ZD, Q,  R,CIM,  CMS 


OUTPUTS  :  RRELTR, MAGRTR, VRELTR, MGRDTR, MAGLOS, LAMTRU, 

LAMDXX, LAMDTR, LAMSEK, LAMDSK, TGOTR, RRELM, 
VRELM, CAZ, CEL 


UPDATES  : 


T.  THORNTON 
B.  HILL 
T.  THORNTON 
D.  SMITH 
B.  HILL  / 

R.  RHYNE 
D.  SISSOM 
B.  HILL 


-  CR  #  037 

-  CR  #  038 

-  CR  #  048 

-  CR  #  059 

-  CR  #  081 

-  CR  #  091 

-  CR  #  093 


IMPLICIT  DOUBLE  PRECISION  (A-H) 
IMPLICIT  DOUBLE  PRECISION  (0-Z) 


REAL  CIM (9) 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 


XD,YD,ZD,Q,R 


CMS (9) 
RTIC(5,3) 
MAGRTR 
MAGVTR 
VRELM (3) 
LAMDTR (2) 
LAMSEK (2) 


MAGLOS 
RRELTR (3) 
VTIC {5, 3) 
MGRDTR 
LAMTRU (2) 
RRELS{3) 
LAMDSK (2) 


,  URRELT(3) 
,  VRELTR  (3) 
,  RRELM (3) 

,  LAMDXX (2) 
,  VRELS(3) 


INTEGER  SEKTYP 


*  DATA  INITIALIZATION 
SINCLUDE  ( '  ''/INCLUDE/SSDATA50  .DAT ■ ) 
SINCLUDE  ( '  '•/ INCLUDE/ SSDATA6 6  .DAT  ' ) 
$INCLUDE( '  ''/INCLUDE/SSDATA21  .DAT' ) 


C  COMPUTE  RELATIVE  RANGE,  RANGE  RATE,  AND  TIME-TO-GO 


RRELTR (1)  -  RTIC (1,1)  -  X 
RRELTR(2)  =  RTIC (1,2)  -  Y 
RRELTR(3)  =  RTIC (1,3)  -  Z 


MAGRTR  =  DSQRT (RRELTR(l) **2  +  RRELTR(2)**2  +  RRELTR ( 3) * *2) 
URRELT(l)  =  RRELTR ( 1 ) /MAGRTR 
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URRELT(2)  =  RRELTR(2) /MAGRTR 
URRELTO)  =  RRELTR (3) /MAGRTR 

VRELTR(l)  =  VTIC(1,1)  -  XD 
VRELTR(2)  =  VTIC(1,2)  -  YD 
VRELTR(3)  =  VTIC(1,3)  -  ZD 

MAGVTR  =  DSQRT (VRELTR(l) **2  +  VRELTR(2)**2  +  VRELTR (3) **2) 

MGRDTR  =  VRELTRd)  *URRELT(1)  +  VRELTR  (2)  *URRELT  (2)  + 

VRELTR ( 3 ) *URRELT ( 3 ) 

VRDRRT  =  VRELTR (1) *RRELTR(1)  +  VRELTR(2) *RRELTR(2)  + 

VRELTR ( 3 ) *RRELTR ( 3 ) 

TGOTR  =  -VRDRRT/ (MAGVTR* *2) 

C  COMPUTE  LOS  ANGLES  AND  RATES  IN  BODY  FRAME 

RRELM(l)  =  RRELTR(l) *CIM(1)  +  RRELTR{2) *CIM (4)  +  RRELTR(3) *CIM(7) 
RRFLM(2)  =  RRELTR(l) *CIM(2)  +  RRELTR (2 ) *CIM ( 5)  +  RRELTR { 3) *CIM ( 8) 
RRELM(3)  =  RRELTR (1) *CIM( 3)  +  RRELTR (2 ) *CIM ( 6)  +  RRELTR ( 3) *C1M ( 9) 

VRELM(l)  =  VRELTR(l) *CIM(1)  +  VRELTR(2) *CIM(4)  +  VRELTR(3) *CIM(7) 
VRELM(2)  =  VRELTRd)  *CIM  (2)  +  VRELTR(2)  *CIM  (5)  +  VRELTR(3)  *CIM(8) 
VRELM{3)  =  VRELTRd)  *CIM(  3)  +  VRELTR{2)  *CIM(6)  +  VRELTR  ( 3)  *CIM  ( 9) 

LAMTRUd)  =  DATAN2  (-RRELM(3)  ,RRELMd)  ) 

LAMTRU(2)  =  DATAN2  (RRELM'2)  ,RRELMd)  ) 

LAMDXXd)  =  (RRELM(3)  *VRELMd)  -  RRELM  (1)  *VRELM  (3)  )  / 

(RRELMd)**2  +  RRELM(3)**2) 

LAMDXX(2)  =  (RRELMd)  *VRELM(2)  -  RRELM (2)  *VRELM (1)  )  / 

(RRELMd)**2  +  RRELM(2)**2) 

LAMDTRd)  =  LAMDXXd)  -  Q 
LAMDTR(2)  =  LAMDXX(2)  -  R 

C  COMPUTE  LOS  ANGLES  AND  RATES  IN  SEEKER  FRAME 

RRELSd)  =  RRELMd)  *CMSd)  +  RRELM(2)  *CMS  (4)  +  RRELM  ( 3 )  *CMS  ( 7 ) 
RRELS(2)  =  RRELMd)  *CMS  (2)  +  RRELM (2)  *CMS  (5)  +  RRELM (3)  *CMS  (8) 
RRELS(3)  =  RRELMd)  *CMS( 3)  +  RRELM (2)  *CMS  ( 6)  +  RRELM ( 3)  *CMS  ( 9) 

VRELSd)  =  VRELMd)  *CMS  (1)  +  VRELM(2)  *CMS  (4)  +  VRELM  ( 3)  *CMS  (7 ) 

VRELS(2)  =  VRELMd)  *CMS  (2)  +  VRELM(2)  *CMS  (5)  +  VRELM  (3)  *CMS  (8) 

VRELS(3)  =  VRELMd)  *CMS(  3)  +  VRELM  (2)  *CMS  ( 6)  +  VRELM  (3)  *CMS  (9) 

LAMSEKd)  =  DATAN2  (-RRELS( 3)  , RRELSd)  ) 

LAMSEK(2)  =  DATAN2  (RRELS  (2) , RRELSd) ) 

MAGLOS  =  DABS (DAT AN2 (DSQRT (RRELS (2) * *2  +  RRELS (3) **2) , 

RRELS (1) )) /DTR 

LAMDSKd)  =  (RRELS  (3)  *VRELS  (1)  -  RRELS  (1)  *VRELS  (3)  )  / 

(RRELS d)**2  +  RRELS(3)**2) 

LAMDSK(2)  =  (RRELSd)  *VRELS  (2)  -  RRELS  (2)  *VRELS  (1)  )  / 

(RRELS (1)**2  +  RRELS(2)**2) 

RETURN 

END 
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B.2.33  Uuresp2r.for 


SUBROUTINE  RESP2R  ( 

DT,WD, ZD, CILL, CIL, Cl, COLL, COL, CO  ) 

SUBROUTINE  NAME  : 

RESP2R 

AUTHOR (S)  : 

D.  F.  SMITH 

FUNCTION  : 

Given  a  second  order  continuous  filter  of 
the  form 

WD**2 

G(s)  - - 

s**2  +  2.0*ZD*WD*S  +  WD**2 

compute  a  digital  filter  which  yields  the 
same  ramp  response  .  The  digital  filter  has 
the  transfer  function 

CI*2**2  +  CIL*z  +  CILL 

G(z)  - - 

CO*z**2  +  COL*z  +  COLL 

CALLED  FROM  ; 

UTILITY  ROUTINE 

SUBROUTINES  CALLED 

:  NONE 

INPUTS  : 

DT,WD,ZD 

OUTPUTS  : 

CILL, CIL, Cl, COLL, COL, CO 

UPDATES  : 

NONE 

IMPLICIT  DOUBLE  PRECISION  (A-H) 

IMPLICIT  DOUBLE  PRECISION  (O-Z) 

DATA  ONE  /  l.ODO  / 

DATA  TWO  /  2.0D0  / 

C  Underdamped  filter 

IF  (  ZD.LT.ONE  )  THEN 
A  =  WD*ZD 

B  =  WD*DSQRT  (  ONE  -  ZD* *2  ) 

TMPl  =  DEXP  {  -  A*DT  ) 

TMP2  =  DEXP  (  -  TWO*A*DT  ) 

TMP3  =  DCOS  (  B*DT  ) 

TMP4  =  DSIN  (  B*DT  ) 

TMP5  =  A*A  +  B*B 

TMP6  =  TMP1*TMP4*(  A*A  -  B*B  ) /B 

Cl  =  TMP5*DT  -  TWO*A  +  TWO*A*TMPl*TMP3  +  TMP6 

CIL  =  TWO*(  A  -  DT*TMP1*TMP3*TMP5  -  TMP6  -  A*TMP2  ) 

CILL  =  TMP6  -  TWO*A*TMPl*TMP3  +  TMP2* (  TWO*A  +  TMP5*DT  ) 
CO  =  TMP5*nT 

COL  =  -  TWO*TMPl*TMP3*CO 

COLL  =  TMP2*CO 

END  IF 

C  Critically  damped  filter 
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IF  (  ZD.EQ.ONE  )  THEN 
A  =  WD 

TMPl  =  DEXP  (  -  A*DT  ) 

TMP2  =  DEXP  (  -  TWO*A*DT  ) 

TMP3  =  TWO  +  A*DT 

TMP4  =  -  TWO  +  A*DT 

Cl  =  TMP1*TMP3  +  TMP4 

CIL  =  TWO*{  ONE  -  TWO*A*DT*TMPl  -  TMP2  ) 

CILL  =  TMP1*TMP4  +  TMP2*TMP3 

CO  =  A*DT 

COL  =  -  CO*TWO*TMPl 
COLL  =  CO*TMP2 

END  IF 

C  overdamped  filter 

IF  (  ZD.GT.ONE  )  THEN 

TMP5  =  DSQRT  (  ZD**2  -  ONE  ) 

A  =  WD*TMP5 

B  =  WD/TMP5 

ASQ  =  A*A 

BSQ  =  B*B 

EXPA  =  DEXP  (  -  A*DT  ) 

EXPB  =  DEXP  (  -  B*DT  ) 

TMPl  =  A*DT  +  EXPA  -  ONE 

TMP2  =  B*DT  +  EXPB  -  ONE 

TMP3  =  ONE  +  A*DT 

TMP4  =  ONE  +  B*DT 

Cl  =  ASQ*TMP2  -  BSQ*TMP1 

CIL  =  ASQ*(  ONE  -  EXPA*TMP2  -  EXPB*TMP4  ) 

-  BSQ*(  ONE  -  EXPB*TMP1  -  EXPA*TMP3  ) 

CILL  =  ASQ*EXPA*(  EXPB*TMP4  -  ONE  ) 

-  BSQ*EXPB*(  EXPA*TMP3  -  ONE  ) 

CO  =  A*B*DT*(  A  -  B  ) 

COL  =  -  CO*(  EXPA  +  EXPB  ) 

COLL  =  CO*EXPA*EXPB 

END  IF 

RETURN 

END 
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B.2.34  Uuresthr.for 

c - 

SUBROUTINE  RESTHR (T, IDIST, ANVP, DTSAMP, TOFLTM, TRATON, TPATON, TYATON, 
DTACSA,DTACSB) 


SUBROUTINE  NAME  :  RESTHR 

AUTHOR (S)  :  T.  THORNTON 

FUNCTION  :  ATTITUDE  CONTROL  SYSTEM  THRUSTER 

CROSS  COUPLING  LOGIC 

CALLED  FROM  :  FORTRAN  MAIN 


SUBROUTINES  CALLED  :  NONE 


INPUTS  ; 
OUTPUTS  : 
BOTH  : 


T, IDIST, ANVP, DTSAMP, TOFLTM 

DTACSA,DTACSB 

TRATON, TPATON, TYATON 


UPDATES  ; 


B. 

HILL 

- 

CR 

# 

038 

T. 

THORNTON 

- 

CR 

# 

043 

T. 

THORNTON 

- 

CR 

# 

044 

B. 

HILL 

- 

CR 

# 

051 

D. 

SMITH 

- 

CR 

# 

059 

B. 

HILL  / 

- 

CR 

# 

081 

R. 

RHYNE 

R. 

RHYNE 

- 

CR 

# 

084 

B, 

HILL 

- 

CR 

# 

086 

B. 

HILL 

- 

CR 

# 

093 

IMPLICIT  REAL  <A-H) 

IMPLICIT  REAL  (O-Z) 

REAL  DTACSA(4)  ,  DTACSB(4) 

*  DATA  INITIALIZATION 
$  INCLUDE  ( '  ''/INCLUDE/SSDATA67  .DAT  ' ) 

$ INCLUDE ( ' "/ INCLUDE /SSDATAO 3 .DAT' ) 

$ INCLUDE ( ' "/INCLUDE/SSDATA08 .DAT' ) 

C  IN  DISTURBANCE  MODE  TURN  OFF  ACS  THRUSTERS  WITH  DIVERT  THRUSTERS 

IF(  IDIST  .EQ.  1  )  THEN 
TMPl  =  TOFLTM  -  T 
IF(  TMPl  .LE.  0.  )  THEN 
TMP2  =  0. 

ELSEIF'(  TMPl  .LT.  TSMPH  )  THEN 
TMP2  =  TMPl /TSMPH 
ELSE 

TMP2  =  1. 

END  IF 

TPATON  =  TPATON *TMP 2 
TYATON  =  TYATON *TMP 2 
TRATON  =  TRATON*TMP2 
ENDIF 


373 


o  o 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


C  TEST  SIGNS  OF  PITCH,  YAW,  ROLL  AND  ATTITUDE  THRUSTER  PULSEWIDTHS 

C  PITCH  SIGN  TEST 

IF(  TPATON  .GE.  0.0  )  THEN 
TPATP  =  TPATON 
TPATN  =0.0 
ELSE 

TPATP  =0.0 
TPATN  =  -TPATON 
ENDIF 

C  YAW  SIGN  TEST 

IF(  TYATON  .GE.  0.0  )  THEN 
TYATP  =  TYATON 
TYATN  =0.0 
ELSE 

TYATP  =0.0 
TYATN  =  -TYATON 
ENDIF 

C  ROLL  SIGN  TEST 

IF(  TRATON  .GE.  0.0  )  THEN 
TRATP  =  TRATON 
TRATN  =0.0 
ELSE 

TRATP  =0.0 
TRATN  =  -TRATON 
ENDIF 

RESOLVE  PITCH,  YAW,  AND  ROLL  THRUSTER  PULSEWIDTHS  INTO 
INDIVIDUAL  THRUSTER  PULSEWIDTHS 


IF(  ANVP  .LT 

1.5  )  THEN 

DTACSA(l) 

TPATP 

+ 

TRATP 

DTACSB(l) 

= 

TPATN 

+ 

TRATN 

DTACSA(2) 

= 

TYATP 

DTACSB(2) 

5= 

TYATN 

DTACSA(3) 

S= 

TPATN 

+ 

TRATP 

DTACSB(3) 

= 

TPATP 

+ 

TRATN 

DTACSA(4) 

= 

TYATN 

DTACSB(4) 

= 

TYATP 

ELSE 

DTACSA(l) 

= 

TPATP 

+ 

TRATP 

DTACSB(l) 

= 

TPATN 

+ 

TRATN 

DTACSA(2) 

= 

TYATP 

+ 

TRATP 

DTACSB(2) 

= 

TYATN 

+ 

TRATN 

DTACSA{3) 

= 

TPATN 

+ 

TRATP 

DTACSB(3) 

= 

TPATP 

+ 

TRATN 

DTACSA(4) 

= 

TYATN 

+ 

TRATP 

DTACSB(4) 

= 

TYATP 

+ 

TRATN 

ENDIF 

DO  50  1=1,4 

C  ENFORCE  THRUSTER  PAIR  DEADBANDS 

IF{  ABS(  DTACSA(I)  -  DTACSB(I)  )  . LT .  ACSDB  )  THEN 
DTACSA(I)  =0.0 
DTACSB(I)  =0.0 
ENDIF 
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ENFORCE  MINIMUM  COMMAND  ON  TIME 


IF( (DTACSA(I) 

.LT. 

TCMINA  . 

AND.  DTACSAd)  .GT. 

0.) 

.OR. 

(DTACSB(I) 

.LT. 

TCMINA  . 

AND.  DTACSBd)  .GT. 

0.)) 

THEN 

DTACSA(I)  = 

DTACSA(I)  + 

TCMINA 

DTACSB(I)  = 

DTACSBd)  + 

TCMINA 

ENDIF 

IF(  DTACSA(I) 

.GT. 

DTSAMP  ) 

DTACSAd)  =  DTSAMP 

IF{  DTACSBd) 

.GT. 

DTSAMP  ) 

DTACSBd)  =  DTSAMP 

CONTINUE 

RETURN 

END 
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B.2.35  Uurotmx.for 


SUBROUTINE  ROTMX{X, 

I,XM) 

SUBROUTINE  NAME  : 

ROTMX 

AUTHOR (S)  : 

J.  SHEEHAN 

FUNCTION  : 

GENERATES  A  DIRECTION  COSINE  MATRIX 

CALLED  FROM  : 

UTILITY  SUBROUTINE 

SUBROUTINES  CALLED 

:  NONE 

INPUTS  : 

X,I 

OUTPUTS  : 

XM 

UPDATES  : 

D.  SMITH  -  CR  #  59 

IMPLICIT  DOUBLE  PRECISION  (A-H) 
IMPLICIT  DOUBLE  PRECISION  (0-Z) 
DOUBLE  PRECISION  XM(3,3) 

C 

INTEGER  IIT(3) ,  IIIT(3) 

DATA  IIT  /  2  ,  3  ,1  / 

,IIIT/  3,1  ,2  / 

C 

SX  =  DSIN(X) 

CX  =  DCOS(X) 

II  =  IIT(I) 

III  =  IIIT(I) 

C 

XM{I,I)  =  1.0 
XM(I,II)  =  0.0 
XM(I,III)  =  0.0 
XM(II,I)  =  0.0 
XM(III, I)  =0.0 
C 

XM(II,II)  =  CX 
XM(III,III)  =  CX 
XM(II,III)  =  SX 
XM(III,II)  =  -SX 
C 

RETURN 

END 
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B.2.36  Uuseeker.for 

c - 

SUBROUTINE  SEEKER (T, ACQD, LAMSEK, MAGRTR, SKSEED,  FRMRAT, FRMCNT, 
SAMRAT, TRACK, TERM, SNR, LAMM) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 
FUNCTION  : 

CALLED  FROM  : 


SEEKER 

M.  K.  DOUBLEDAY,  D.  C.  FOREMAN 
SEEKER  MODEL 
FORTRAN  MAIN 


SUBROUTINES  CALLED  : 
INPUTS  : 

OUTPUTS  : 

BOTH  : 

UPDATES  ; 


NORM,  TABLE 
T, ACQD, LAMSEK, MAGRTR 
SAMRAT, TRACK, TERM, SNR, LAMM 
SKSEED, FRMRAT, FRMCNT 


T. 

THORNTON 

- 

CR 

# 

014 

B. 

HILL 

- 

CR 

# 

020 

D. 

SMITH 

- 

CR 

# 

027 

B. 

HILL 

- 

CR 

# 

030 

B. 

HILL 

- 

CR 

# 

038 

T. 

THORNTON 

- 

CR 

# 

043 

T. 

THORNTON 

- 

CR 

# 

044 

T. 

THORNTON 

- 

CR 

# 

048 

D. 

SISSOM 

- 

CR 

# 

053 

D. 

SMITH 

- 

CR 

# 

059 

D. 

SMITH 

- 

CR 

# 

064 

D. 

SISSOM 

- 

CR 

# 

069 

D. 

SMITH 

- 

CR 

# 

074 

D. 

SMITH 

- 

CR 

# 

080 

B. 

HILL  / 

- 

CR 

# 

081 

R., 

RHYNE 

D. 

SMITH 

- 

CR 

# 

082 

R. 

RHYNE 

- 

CR 

# 

084 

R, 

RHYNE 

- 

CR 

# 

087 

R. 

RHYNE 

- 

CR 

# 

088 

B. 

HILL 

- 

CR 

# 

093 

C 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 


CHARACTER* 12 8  MESSAGE 
REAL  ACQRNG(4,4)  , 

REAL  LAMM (2)  , 

REAL  LAMSK(2)  , 

REAL  NEA 
REAL  SEKTIM{24) 


LAMB (2) 
LAMNEA(2) 
MAGRTR 
RATE (6) 
TRGSIG(4) 


LAMFOV 
LAMSEK (2) 

SEKNOS (24) 


INTEGER  ACnn 

INTEGER  SEKTYP 

INTEGER*4  SKSEED 

INTEGER  TERM 


BCKGPI>  ,  FPMCNT 

TRACK 


LOCAL  COMMON  USED  FOR  CONSTANTS  AND  INITIALIZATION  FLAG 
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SAVE  ISEKR,  IFOV 

*  DATA  INITIALIZATION 
$  INCLUDE  ( '  ''Z  INCLUDE/ SSDATA4  7  .DAT  ' ) 

SINCLUDE ( ' ^/INCLUDE/SSDATA48 . DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA50  .DAT ' ) 

$  INCLUDE  ( '  ''/INCLUDE/SSDATA55  .DAT' ) 

$ INCLUDE ( ' ^/INCLUDE/SSDATA61 .DAT • ) 

$  INCLUDE  ( ' ''/ INCLUDE /SSDATA6  8  .DAT ' ) 

$ INCLUDE ( ' ^/INCLUDE/SSDATAIO .DAT ' ) 

$  INCLUDE  (  '  /  INCLUDE/  SSDATAl  1 .  DAT  ' ) 

DATA  ISEKR  /  1  / 

DATA  IT  /  1  / 

IF  (ISEKR. EQ.l)  THEN 

ISEKR  =  0 

IF  (  SEKTYP.EQ.2  )  THEN 
TSIG  =  TRGSIG(ITRGSG) 

TSGACQ  =  TSIG 

RAQREF  =  ACQRNG(BCKGRD,ITRGSG) 

RNGAC  =  SQRT( (TSGACQ/TSIG) * (6.0/SNRACQ) * 

.  (SQRTd./FRMRAT)  )  )*RAQREF 

ENDIF 

END  IF 

C  TEST  FOR  FIELD-OF-VIEW  LIMIT 

IF  <  SEKTYP.EQ.2  .AND.  SNR . GE . SNRACQ  )  THEN 
FOVCHK  =  FOVLIM 

ELSE  IF  (  ACQD.EQ.l  .AND.  SEKTYP.NE.2  )  THEN 
FOVCHK  =  FOV 
ELSE 

FOVCHK  =  1000. 

ENDIF 

LAMFOV  =  AMAXK  LAMSEK(l)  ,  LAMSEK(2)  ) 

IF  {  LAMFOV . GE . FOVCHK  .AND.  IFOV.EQ.O  )  THEN 

CALL  OUTMESC  TRUE  LOS  ANGLE  EXCEEDS  FIELD-OF-VIEW  LIMIT') 
IFOV  =  1 

ELSE  IF  (  LAMFOV. LE. FOVCHK  .AND.  IFOV. EQ.l  )  THEN 
CALL  OUTMESC  TARGET  REACQUIRED') 

IFOV  =  0 
ENDIF 

C  DETERMINE  SEEKER  SAMPLE  RATE  FOR  SEEKER  TYPES  0  AND  1 

IF  (  SEKTYP.EQ.O  .OR.  SEKTYP.EQ.l  )  THEN 
IF  (  MAGRTR  .LE.  RNGTRM  )  THEN 
SAMRAT  =  SAMTRI4 
IF  (TERM.EQ.O)  TERM  =  1 
ELSE  IF  (  MAGRTR  .LE.  RNGTRK  )  THEN 
SAMRAT  =  SAMTRK 
IF  (TRACK. EQ.O)  TRACK  =  1 
ELSE 

SAMRAT  =  .SAMACQ 
ENDIF 
ENDIF 

C  PERFECT  SEEKER  MODEL 
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IF  (  SEKTYP.EQ.O  )  THEN 
LAMM(l)  =  LAMSEK(l) 

LAMM(2)  =  LAMSEK(2) 

FRMRAT  =  1.0/SAMRAT 
END  IF 

C  SEEKER  MODEL  DEPENDENT  ON  UiNGE,  tRAME,  AND  ENVIRONMENT 

IF  (  SEKTYP.EQ.2  )  THEN 

C  DETERMINE  THE  SIGNAL-TO-NOISE  TAT 10 

IF  (  MAGRTR.LE.RFINAL  )  THEN 

SNR  =  (RAQREF**2/RFINAL**2) ' (TSGACQ/TSIG) * 

(SORT (1 . 0/FRMRAT) ) *SNRACQ 

ELSE 

SNR  =  (RAQREF**2/MAGRTR**2) * (TSGACQ/TSIG) * 

(SORT ( 1 . 0/FRMRAT) ) *SNRACQ 

END  IF 

C  CALCULATE  THE  NOISE  EQUIVALENT  ANGLE  (RADIANS)  FROM  THE 

C  EFFECTIVE  SNR 

NEA  =  (32. 56*SNR**(-0. 29912))*!. OE-6 

C  MULTIPLY  NOISE  EQUIVALENT  ANGLE  BY  NORMALLY  DISTRIBUTED  RANDOM 

C  VARIABLE  WITH  A  MEAN  OF  ZERO  AND  A  STANDARD  DEVIATION  OF  ONE 

CALL  spNORM(1.0e0,0.0,SKSEED,RANA) 

CALL  spNORM(1.0e0,0.0,SKSEED,RANB) 

LAMNEA(l)  =  NEA*RANr 
LAMNEA(2)  =  NEA*RANB 

C  DETERMINE  MEASURED  LOS  ANGLE  (RADIANS) 

LAMB(l)  =  LAMSEK(l)  +  LAMNEA(l) 

LAMB (2)  =  LAMSEK(2)  +  LAMNEA(2) 

C  QUANTIZE  THE  MEASURED' LOS  iiNGLE  (RADIANS) 

IF  (  QNTZP.GT.0.0  )  THEN 

LAMM(l)  =  (AINT(LAMB(1) /QNTZP  +  0.5))*QNTZP 
LAMM(2)  =  (AINT (LAMB (2) /QNTZP  +  0.5))*QNTZP 
ELSE 

LAMM(l)  =  LAMB(l) 

LAMM (2)  =  LAMB (2) 

END  IF 

C  DETERMINE  IF  A  FRAME  RATE  SWITCH  IS  REQUIRED 

IF  (  MAGRTR.LE.RFINAL  )  THEN 

FRMR  =  ( (6. 0/SNRMIN) * (TSGACQ/TSIG) * (RAQREF**2/RFINAL**2) ) **2 
ELSE 

FRMR  =  ( (6. 0/SNRMIN) * (TSGACQ/TSIG) * (RAQREF**2/MAGRTR**2) ) **2 
END  IF 

IF  (  FRMR. GE. RATE (FRMCNT)  .AND.  FRMCNT . LT . 7  )  THEN 
FPvMRAT  =  RATE  (FRMCNT) 

FRMCNT  =  FRMCNT  +  1 
WRITE (MESSAGE, 101)  T, FRMRAT 
CALL  OUTMES (MESSAGE) 

101  FORMAT (IX, El 6. 9,  '  FRAME  RATE  CHANGE:  FRMRAT  =  ',E16.9) 

END  IF 
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ENDIF 

RETURN 

END 
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B.2.37  Uuspint.for 

c - 

SUBROUTINE  spINTEG  (  X  ,  XDOT  ,  T  ,  I  ) 


SUBROUTINE  NAME  ; 

INTEG 

AUTHOR (S)  : 

D.  F.  SMITH 

FUNCTION  : 

Perform  simple  trapezoidal  integration  i 
XDOT  to  yield  X.  DTD  is  the  time  since 
the  last  integration  and  I  is  the  array 
index  where  X  is  stored 

CALLED  FROM  : 

FORTRAN  MAIN 

SUBROUTINES  CALLED  : 

NONE 

INPUTS  : 

XDOT,T, I 

OUTPUTS  : 

X 

UPDATES  : 

D.  SISSOM  -  CR  #  58 

D.  SMITH  -  CR  #  59 

COMMON/STORAG/ 

XINT, 

TINT, 

XDOTL 

REAL  XINT  (50), 

TINT(50) , 

XDOTL(50) 

REAL  DT, 

DTMP, 

X 

REAL  XDOT, 

T 

DT  =  T  -  TINT (I) 


XINT(I)  =  XINT(I)  +  0.5*DT*(XDOT+XDOTL(I) ) 
X  =  XINT(I) 


TINT(I)  =  T 
XDOTLd)  =  XDOT 


C  TEMPORARY  CODE  TO  NORMALIZE  QUATERNION  AFTER  4TH  COMPONENT  IS 
REVISED 


IF  (  I.EQ.18  )  THEN 

DTMP  =  SQRT  (  XINT(15)**2  +  XINT(16)**2  +  XINT(17)**2  + 
XINT(18)**2  ) 


XINT(15) 
XINT (16) 
XINT(17) 
XINT(18) 
END  IF 


=  XINT(15) 
=  XINT (16) 
=  XINT(17) 
=  XINT (18) 


DTMP 

DTMP 

DTMP 

DTMP 


RETURN 

END 
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B.2.38  Uuspinti.for 

c - 

SUBROUTINE  spINTEGI  (  X  ,  XDOT  ,  T  ,  I  ) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 

FUNCTION  : 

CALLED  FROM  : 
SUBROUTINES  CALLED 
INPUTS  : 

OUTPUTS  : 

UPDATES  : 


INTEGI 
D.  F.  SMITH 

Initialize  integral  of  X  which  is  stored 
in  position  I  of  the  integral  array 

MAIN 

NONE 

X,XDOT,T,I 

NONE 

D.  SISSOM  -  CR  #  58 
D.  SMITH  -  CR  #  59 


COMMON/STORAG/ 
REAL  XINT(50), 
REAL  X, 


XINT,  TINT,  XDOTL 

TINT (50),  XDOTL (50) 

T,  XDOT 


XINT (I)  =  X 

XDOTL (I)  =  XDOT 
TINT(I)  =  T 


RETURN 

END 
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B.2.39  Uuspmmk.for 

c - 

SUBROUTINE  SPMMK  (A,  NA,  B,  NB,  C,  NC,  RM), 


SUBROUTINE  NAME  :  MMK 


AUTHOR (S) 


J.  SHEEHAN 


FUNCTION 


GENERATES  A  DIRECTION  COSINE  MATRIX 


BY  ROTATING  IN  ORDER: 

1) 

ANGLE 

C 

ABOUT 

THE 

NC 

AXIS 

2) 

ANGLE 

B 

ABOUT 

THE 

NB 

AXIS 

3) 

ANGLE 

A 

ABOUT 

THE 

NA 

AXIS 

CALLED  FROM 


UTILITY  SUBROUTINE 


SUBROUTINES  CALLED  ;  ROTMX,  MMLXY 
INPUTS  :  A,NA,B,NB,C,NC 


OUTPUTS  : 


RM 


UPDATES  : 


D.  SMITH  -  CR  #  59 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

C 

DIMENSION  AM (3,3) ,  BM(3,3),  CM(3,3),  RM(3,3),  T(9) 
C 

CALL  SPROTMX(A,NA, AM) 

CALL  SPROTMX(B,NB,BM) 

CALL  SPROTMX(C,NC,CM) 

C 

CALL  SPMMLXY(BM,CM,T) 

CALL  SPMMLXY(AM,T,RM) 

C 

RETURN 

END 
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B.2.40  Uuspmmlx.for 

c - 

SUBROUTINE  SPMMLXY ( X , Y , Z ) 


SUBROUTINE  NAME  ; 
AUTHOR (S)  : 

FUNCTION  : 

CALLED  FROM  : 
SUBROUTINES  CALLED  : 
INPUTS  : 

OUTPUTS  : 

UPDATES  : 


MMLXY 
J.  SHEEHAN 

MULTIPLY  TWO  3X3  MATRICES 
UTILITY  SUBROUTINE 
NONE 
X,  Y 
Z 

D.  SMITH  -  CR  #  59 


IMPLICIT  REAL  (A-H) 
IMPLICIT  REAL  (0-Z) 


DIMENSION  X( 3, 3) ,  Y(3,3),  Z(3,3) 


Z(I,J)  = 

Z(l,l)  = 
Z(2,l)  = 
Z(3,l)  = 
Z(l,2)  = 
Z(2,2)  = 
Z(3,2)  = 
Z(l,3)  = 
Z{2,3)  = 
Z(3,3)  = 
C 

RETURN 

END 


X(I,1)  *Y(1,  J) 

X(1,1)*Y(1,1) 
X(2,1)*Y(1,1) 
X(3,l)  *Y(1,1) 
X{1,1) *Y(1,2) 
X(2,l) *Y(1,2) 
X(3,1)*Y(1,2) 
X(1,1)*Y(1,3) 
X(2,l)  *Y(1,3) 
X(3,l)  *Y(1,3) 


+  X(I,2) *Y(2, J) 

+  X(l,2) *Y(2, 1) 
+  X(2,2) *Y{2,1) 
+  X(3,2) *Y(2,1) 
+  X(l,2) *Y(2,2) 
+  X(2,2) 'Y(2,2) 
+  X(3,2) *Y(2,2) 
+  X(1,2)*Y(2,3) 
+  X(2,2) *Y(2,3) 
+  X(3,2) *Y(2,3) 


+  X(I,3)  *Y(3,  J) 

+  X(1,3)*Y(3,1) 
+  X(2,3) *Y(3,1) 
+  X(3,3)*Y(3,1) 
+  X(l,3) *Y{3,2) 
+  X(2,3) *Y(3,2) 
+  X(3,3) *Y(3,2) 
+  X(l,3) *Y(3,3) 
+  X(2,3) *Y(3,3) 
+  X(3,3) *Y(3,3) 
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B.2.41  Uuspran.for 


REAL  FUNCTION  RAN(ISEED) 


SUBROUTINE  NAME  : 

RAN 

AUTHOR (S)  : 

D.  F.  SMITH 

FUNCTION  : 

GENERATES  A  UNIFORMLY  DISTRIBUTED  RANDOM 
NUMBER 

CALLED  FROM 

UTILITY  SUBROUTINE 

SUBROUTINES  CALLED  : 

NONE 

INPUTS  : 

NONE 

OUTPUTS  : 

RAN 

BOTH  : 

ISEED 

UPDATES  : 

NONE 

integer*4  iseed 

iseed  =  69069*iseed  +  1 

ran  =  abs (float (iseed) /2147483647 .0) 

RETURN 

END 
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B.2.42  UuspranO.for 

c - 

REAL  FUNCTION  spRANO ( ISEED) 


SUBROUTINE  NAME  :  RANG 


AUTHOR (S)  :  D.  F.  SMITH 

FUNCTION  :  GENERATES  A  UNIFORMLY  DISTRIBUTED  RANDOM 

NUMBER  BETWEEN  0  AND  1  USING  THE  SYSTEM 
ROUTINE  RAN (ISEED)  .  THE  BUFFER  IN  COMMON 
BLOCK  RANCOM  IS  INITIALIZED  BY  CALLING 
ROUTINE  RANIT  . 


CALLED  FROM  : 
SUBROUTINES  CALLED 
INPUTS  : 

OUTPUTS  : 

BOTH  : 

UPDATES  : 


UTILITY  SUBROUTINE 

RAN 

NOl.t; 

RANG 

ISEED 

NONE 


integer*4  iseed 

COMMON  /  RANCOM  /  RANSEQ(97),  RANLST 

USE  PREVIOUSLY  SAVED  RANDOM  NUMBER  AS  BUFFER  INDEX  AND  MAKE 
SURE  ARRAY  BOUNDS  ARE  NOT  EXCEEDED  . 


J  =  1  +  INT  (  97.0*RANLST  ) 

IF  {  J.LT.l  .OR.  J.GT.97  )  THEN 

CALL  OUTMESC  RANDOM  NUMBER  OUT  OF  BOUNDS  IN  RANG') 

END  IF 

RETRIEVE  RANDOM  NUMBER  FROM  BUFFER  FOR  OUTPUT  AND  SAVE  IT  FOR 
USE  AS  AN  INDEX  ON  THE  NEXT  PASS  . 

RANLST  =  RANSEQ(J) 

SPRANO  =  RANLST 

C  LOAD  A  NEW  RANDOM  NUMBER  IN  THE  SLOT  JUST  VACATED  . 

RANSEQ(J^  =  RAN  (  ISEED  ) 

RETURN 

END 
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B.2.43  Uusprotm.for 


SUBROUTINE  SPROTMX (X, I, XM) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 

FUNCTION  : 

CALLED  FROM  : 
SUBROUTINES  CALLED  : 
INPUTS  : 

OUTPUTS  : 

UPDATES  : 


ROTMX 
J.  SHEEHAN 

GENERATES  A  DIRECTION  COSINE  MATRIX 

UTILITY  SUBROUTINE 

NONE 

X,I 

XM 

D.  SMITH  -  CR  #  59 


IMPLICIT  REAL  (A-H) 
IMPLICIT  REAL  (0-Z) 

REAL  XM(3,3) 

C 

INTEGER  IIT(3)  ,  HIT  (3) 
DATA  IIT  /  2  ,  3  ,1  / 

,IIIT/  3,1  ,2  / 

C 

SX  =  SIN(X) 

CX  =  COS(X) 

II  =  IIT(I) 

III  =  IIIT(I) 

C 

XM(i,:)  =  1.0 
XM{I, II)  =0.0 
XM(I,III)  =  0.0 
XM(II,I)  =  0.0 
XM(III, I)  =0.0 
C 

XM(II,II)  =  CX 
XMdII,  III)  =  CX 
XM(II,III)  =  SX 
XMdII,  II)  =  -SX 
C 

RETURN 

END 
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B.2.44  Uutable.for 

c - 

SUBROUTINE  spTABLE (XTAB, YTAB, X, Y, N, I) 


SUBROUTINE  NAME  :  TABLE 


AUTHOR (S)  ;  D.  SMITH 

FUNCTION  ;  PERFORMS  TABLE  LOOKUP  VIA  EITHER  INDEXED 

SEARCH  OR  BINARY  SEARCH  AND  LINEARLY 
INTERPOLATES 


CALLED  FROM 
SUBROUTINES  CALLED  : 
INPUTS  : 

OUTPUTS  : 

BOTH  : 

UPDATES  : 


UTILITY  SUBROUTINE 
NONE 

XTAB, YTAB, X,N 

Y 

I 


D. 

SMITH 

-  CR 

# 

27 

B. 

HILL 

-  CR 

# 

38 

B. 

HILL 

-  CR 

# 

46 

D. 

SMITH 

-  CR 

# 

59 

IMPLICIT  real  (A-H) 
IMPLICIT  real  (0-Z) 
INTEGER  N,I 
real  XTAB (N) , YTAB (N) 


IF  (  I.GE.l  .AND.  I.LE.N  )  THEN 
IF  (  X.LE.XTAB(l)  )  THEN 

Y  =  YTAB(l) 

I  =1 

ELSE  IF  {  X.GE.XTAB{N)  )  THEN 

Y  =  YTABIN) 

I  =  N 

ELSE  IF  {  X.GE.XTABd)'  I  THEN 
DO  10  K  =  I  ,  N-1 

IF  (  X.LT.XTAB(K+1)  )  GO  TO  20 
10  CONTINUE 

20  FRACT  =  (  X  -  XTAB(K)  )  /  (  XTAB{K+1) 

Y  =  YTAB(K)  +  FRACT  *  (  YTAB{K+1) 

I  =  K 

ELSE  IF  (  X.LT.XTAB(I)  )  THEN 
DO  30  K  =  I-l  ,  1  ,  -1 

IF  (  X.GE.XTAB(K)  )  GO  TO  40 
30  CONTINUE 

40  FRACT  =  {  X  -  XTAB(K)  )  /  (  XTAB(K+1) 

Y  =  YTAB(K)  +  FRACT  *  (  YTAB(K+1) 

I  =  K 

END  IF 


XTAB(K)  ) 
YTAB(K)  ) 


XTAB(K)  ) 
YTAB(K)  ) 


PERFORM  BINARY  SEARCH  IF  POINTER  IS  ZERO  OR  OUT  OF  BOUNDS 

ELSE  IF  {  I.LT.l  .OR.  I.GT.N  )  THEN 

IF  (  X.GT.XTAB(l)  .AND.  X.LT.XTAB(N)  )  THEN 
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K  =1 

L  =  N 

DO  50  I  =  K  ,  L 

IF  (  L.EQ.K+1  )  GO  TO  60 
M  =  (  K  +  L  )  /  2 

IF  (  X.LT.XTAB(M)  )  THEN 
L  =  M 

ELSE 

K  =  M 

END  IF 

50  CONTINUE 

60  FRACT  =  (  X  -  XTAB(K)  )  /  (  XTAB{L) 

Y  =  yTAB(K)  +  FRACT  *  {  YTAB(L) 

I  =  K 

ELSE  IF  (  X.LE.XTAB(l)  )  THEN 

Y  =  YTAB(l) 

I  =1 

ELSE  IF  (  X.GE.XTAB(N)  )  THEN 

Y  =  YTAB (N) 

I  =  N 

END  IF 
END  IF 


XTAB(K)  ) 
YTAB(K)  ) 


RETURN 

END 


ooooooooooooooonnoooooooooooooonooooooo 


Appendix  B  -  Exosim  v2.0  Midcourse  and  Terminial  Phases 


B.2.45  Uuvcsth2.for 

Q - 

SUBROUTINE  VCSTHR2 (T, FLTC, FLTCP, FLTCY, TBURNM, TOFFLT, 
TIMONV, IVTAB) 


SUBROUTINE  NAME  :  VCSTHR2 

AUTHOR (S)  :  B.  HILL 

FUNCTION  :  RESOLVES  THE  VCS  THRUSTER  BURN  TIMES  INTO 

THEIR  APPROPRIATE  FORCES  AND  MOMENTS 

CALLED  FROM  :  FORTRAN  MAIN 

INPUTS  :  T, TOFFLT, TIMONV 

OUTPUTS  :  FLTCP, FLTCY 

BOTH  :  TBURNM, FLTC, IVTAB 

UPDATES  ;  D.  SISSOM  -  CR  #  017 

B.  HILL  -  CR  #  030 

D.  SISSOM  -  CR  #  032 

B.  HILL  -  CR  #  038 

T.  THORNTON  -  CR  #  043 

B.  HILL  -  CR  #  051 

B.  HILL  -  CR  §  057 

D.  SMITH  -  CR  #  059 

D.  SISSOM  -  CR  #  069 

D.  SMITH  -  CR  #  074 

D.  SMITH  -  CR  #  076 

D.  SMITH  -  CR  #  080 

B.  HILL  /  -  CR  #  081 

R.  RHYNE 

D.  SMITH  -  CR  #  082 

R.  RHYNE  -  CR  #  084 

B.  HILL  -  CR  #  086 

R.  RHYNE  -  CR  #  087 

B.  HILL  -  CR  #  089 

B.  HILL  -  CR  #  093 


IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 

REAL  FLTC  (4)  ,  TOFFLT (4) 

*  DATA  INITIALIZATION 

SINCLUDE  ( '  ''/INCLUDE/SSDATA09 .  DAT ' ) 

IF  (IVTAB  .EQ.  1)  THEN 

ivtab  =  0 

IF  (  TBURNM  .GE.  TCMINV  )'  THEN 

TBURNM  =0.0 

ENDIF 
END  IF 
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DO  30  1=1,4 

IF  {  (TOFFLT(I)-T) .LE.0.0  )  FLTC{I)  =  0.0 
CONTINUE 

IF  (  FLTC(l) .EQ.0.0  .AND.  FLTC (3) .EQ . 0 . 0  .AND. 

(TIMONV) .LE.T  )  FLTCY  =0.0 
IF  (  FLTC(2) .EQ.0.0  .AND.  FLTC (4 ) .EQ . 0 . 0  .AND. 
(TIMONV) .LE.T  )  FLTCP  =0.0 


oooooooooooooooooooooonooooonnooooooooooooo 
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B.2.46  Uuvcsthr.for 

c - 

SUBROUTINE  VCSTHR {T, CG, TBURNM, IVCS,TOFFLT, 

TIMONV, DTOFFV, TVTAB, FOFFl , FOFF2 , IVTAB, TBRK, 
FXVCS,FYVCS,FZVCS,MXVCS,MYVCS,MZVCS,MDOTV) 


SUBROUTINE  NAME  : 
AUTHOR (S)  : 

FUNCTION  : 

CALLED  FROM  : 
SUBROUTINES  CALLED  : 


VCSTHR 
B.  HILL 

RESOLVES  THE  VCS  THRUSTER  BURN  TIMES  INTO 
THEIR  APPROPRIATE  FORCES  AND  MOMENTS 

FORTRAN  MAIN 

TABLE 


INPUTS  :  T, CG, TBURNM, IveS, 

TOFFLT, TIMONV, DTOFFV, TVTAB, FOFFl, FOFF2, IVTAB 


OUTPUTS 


FXVCS, FYVeS, FZVeS, MXVCS, MYVCS, 
M2VCS,MDOTV 


BOTH 


TBRK 


UPDATES 


D.  SISSOM 
B.  HILL 
D.  SISSOM 
B.  HILL 
T.  THORNTON 
B.  HILL 
B.  HILL 
D.  SMITH 
D.  SISSOM 
D.  SMITH 
D.  SMITH 
D.  SMITH 
B.  HILL  / 

R.  RHYNE 
D.  SMITH 
R.  RHYNE 
B.  HILL 
R.  RHYNE 
B.  HILL 
B.  HILL 


- 

CR 

# 

017 

- 

CR 

# 

030 

- 

CR 

# 

032 

- 

CR 

# 

038 

- 

CR 

# 

043 

- 

CR 

# 

051 

- 

CR 

# 

057 

- 

CR 

# 

059 

- 

CR 

# 

069 

- 

CR 

# 

074 

- 

CR 

# 

076 

- 

CR 

# 

080 

- 

CR 

# 

081 

_ 

CR 

# 

082 

- 

CR 

# 

084 

- 

CR 

086 

- 

CR 

# 

087 

- 

CR 

# 

089 

- 

CR 

# 

093 

IMPLICIT  REAL  (A-H) 

IMPLICIT  REAL  (0-Z) 


REAL 

ATHRV ( 4 ) 

,  CG(3) 

REAL 

F(3) 

,  F0(3) 

REAL 

FOFFl  (4) 

,  FOFF2(4) 

REAL 

M(3) 

,  MDOTV 

REAL 

MYVCS 

,  MZVeS 

REAL 

TMVCS(6,4) 

,  TOFFLT (4) 

REAL 

VCSDIR(3,4) 

,  VCSLOC(3,4) 

REAL 

VOFFl  (4) 

,  VOFF2(4) 

,  DTOFFV(4) 

,  ISPVCS 
,  MXVCS 
,  THVCS{6,4) 

,  VCSMA(9,4) 
,  XMOT(3) 


INTEGER  INDX{4) 
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INTEGER  LENVCS(4) 

C  LOCAL  COMMON  USED  FOR  CONSTANTS, LOCAL  VARIABLES  AND 
''  INITIALIZATION  FLAG 

SAVE  IVeSTH  ,  VeSMA 

C  COMMON  "RVCSTR"  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

COMMON  /  RVCSTR  /  TREFLV  ,  TLSTV  ,  TMVCS  ,  THVCS  ,  LENVCS 

*  DATA  INITIALIZATION 
$ INCLUDE ( ' "/ INCLUDE /SSDATA70 .DAT' ) 

$  INCLUDE  (  '  ''/INCLUDE/SSDATA09  .DAT’ ) 

DATA  IVeSTH  /  1  / 

IF  (IVCSTH.EQ.l)  THEN 

IVeSTH  =  0 

C  ves  MISALIGNMENT  DIRECTIONS 

C  VOFFl  =  CONE  ANGLE  OFF  NORMAL 

C  VOFF2  =  POLAR  ANGLE 

DO  10  I  =  1,4 

VOFFl (I)  =  FOFFl(I) 

VOFF2  (I)  =  FOFF2  (I) 

10  CONTINUE 

C  VeS  THRUSTER  MISALIGNMENT  MATRIX 

DO  200  I  =  1  ,  4 

CVOFFl  =  COS (VOFFl (I) ) 

SVOFFl  =  SIN (VOFFl  (I) ) 

CVOFF2  =  COS (VOFF2 (I) ) 

SVOFF2  =  SIN(VOFF2 (I) ) 

VCSMA(1,I)  =  CVOFFl 
VCSMA(2,I)  =  SVOFFl*CVOFF2 
VCSMA(3,I)  =  SVOFFl*SVOFF2 
VCSMA(4,I)  =  SVOFFl*SVOFF2 
VCnMA(5,I)  =  CVOFFl 
VCSMA(6,I)  =  SVOFFl*CVOFF2 
VCSMA(7,I)  =  SVOFFl *CVOFL 2 
VCSMA(8,I)  =  SVOFFl *SVOFF2 
VCSMA(9,I)  --  CVOFFl 
200  CONTINUE 
END  IF 

C  RESET  THE  FORCE  AND  MOMENT  TO  ZERO 

FXVCS  =0.0 
FYVeS  =0.0 
FZVeS  =0.0 
MXVCS  =0.0 
MYVeS  =0.0 
MZVeS  =0.0 
MDOTV  =0.0 

IF  (IVTAB  .£Q.  1)  THEN 

IF  (  TBURNM  .GE.  TCMINV  )  THEN 

C  DEFINE  ves  THRUST  PROFILE 


ooooo  ooo 
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TMVeS (1, IVeS) 
THVCSd,  IVeS) 
TMVeS (2, IVeS) 
THVeS (2, IVeS) 
TMVeSO,  IVeS) 
THVeSO,  IVeS) 
TMVeS (4,  IVeS) 
THVeS (4, IVeS) 
TMVCS(5,IVCS) 
THVCS(5, IVeS) 
TMVCS(6, IVeS) 
THVCS(6, IVeS) 
LENVCS(IVCS) 


=  TVTAB 
=  0.0 
=  TIMONV 
=  0.0 

=  TIMONV  +  TRUPV 
=  FLATM 

=  TIMONV  +  TBURNM 
=  FLATM 

=  TMVCS(4,IVCS)  +  TRDNV 
=  0.0 
=  999.0 
=  0.0 
=  6 


END  IF 


GENERATE  THRUSTER  RESPONSE  CURVE 


15 


DO  15  1=1,4 

IF  {  DTOFFV(I) 
TMVeS (1,  I) 
THVeS (1. I) 
TMVeS (2, I) 
THVeS (2,1) 
TMVeS (3, I) 
THVeS (3, I) 
TMVCS(4,I) 
THVCS(4,  I) 
TMVCS(5,I) 
THVCS(5,I) 
TMVCS(6,I) 
THVCS(6,I) 
LENVeSd) 
END  IF 
CONTINUE 
ENDIF 


.GT.0.0  )  THEN 
=  TVTAB 
=  0.0 

=  TVTAB  +  TLAGV 

=  0.0 

=  TMVCS(2,I)  +  TRUPV 
=  FLATM 
=  TOFFLTd) 

=  FLATM 

=  TMVCS(4,I)  +  TRDNV 
=  0.0 
=  999.0 
=  0.0 
=  6 


SET  TABLE  LOOKUP  REFERENCE  TIME 


TREF  =  T 
DO  20  1=1,4 

COMPUTE  INSTANTANEOUS  THRUST  LEVEL  VIA  TABLE  LOOKUP  IF  VCS 
CYCLE  IS  SCHEDULED  FOR  THIS  THRUSTER  .  ALSO  EXTRAPOLATE  TIME 
OF  NEXT  VCS  TABLE  LOOKUP  INDEX  TRANSITION  . 

IF  {  TMVCSd,!)  .GT.0.0  )  THEN 

CALL  spTABLE(  TMVCSd,  I),  THVCSd,  I)  ,  TREF,  ATHRV  (I)  , 
LENVeSd)  ,  INDXd)  ) 

ELSE 

ATHRV (I)  =0.0 
INDXd)  =  0 
ENDIF 

CALCULATE  FORCES  AND  MOMENTS  DUE  TO  THE  VCS  THRUSTERS  : 

Fd)  IS  THE  FORCE  ALONG  THE  Ith  AXIS. 

XMOT(I)  IS  THE  EFFECTIVE  MOMENT  ARM. 

FORCES  ARE  ADJUSTED  FOR  MISALIGNMENT  EFFECTS. 

THE  MOMENT  GENERATED  IS  (  F  X  XMOT) . 

DO  25  J=l,3 

F0(J)  =  VCSDIR(J,  I)  *ATHRVd) 
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XMOT(J)  =  CG(J)  -  VCSLOC(J,I) 
25  CONTINUE 


F(l) 

F(2) 

F(3) 

M(l) 

M(2) 

M(3) 

FXVCS  = 
FYVeS  = 
FZVeS  = 
MXVCS  = 
MYVeS  = 
MZVeS  = 

MDOTV  = 
20  CONTINUE 

END 


VCSMA(1,I) *F0(1) 
VCSMA(2, I) *F0 (1) 
VCSMA(3, I) *F0 (1) 

F<2) *XMOT(3) 

F(3) *XM0T{1) 

F(l) *XMOT{2) 

FXVCS  +  F(l) 
FYVeS  +  F(2) 
FZVes  +  F<3) 
MXVCS  +  M(l) 
MYVeS  +  M(2) 
MZVeS  +  M(3) 

MDOTV  + 


+VCSMA(4, 1) *F0 (2) 
+VCSMA(5,  I) *F0 (2) 
+VCSMA(6,  I) *F0 (2) 


+VCSMA(7,  I) *F0 (3) 
+VCSMA(8,I)*F0(3) 
+VCSMA(9, I) *F0 (3) 


-  F(3) *XMOT(2) 

-  F{l)*XMOT(3) 

-  F(2)*XMOT(l) 


ATHRV(I) /ISPVCS 
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B.3  Mainlines  (O 


B.3.1  UupOO.c 

/*  uupOO.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Common  Block  Declarations  */ 
struct  { 

real  xint[50],  tint [50],  xdotl[50]; 

)  storag_; 

#define  storag_l  storag_ 
struct  { 

real  tlstm,  massl; 

)  rmass_; 

#define  rmass_l  rmass_ 

struct  { 

real  xyzlch(3]; 

1  rmissl_; 

tdefine  rmissl_l  rmissl_ 

/*  Table  of  constant  values  */ 

static  shortint  cs _ 1  =  1; 

static  shortint  cs _ 5  =  5; 

static  shortint  cs _ 12  =  12; 

static  shortint  cs _ 13  =  13; 

static  shortint  cs _ 14  =  14; 

static  shortint  cs _ 15  =  15; 

static  shortint  cs _ 16  =  16; 

static  shortint  cs _ 17  =  17; 

static  shortint  cs _ 18  =  18; 

static  integer  c _ 1  =  1; 

static  real  c_bl4  =  (float) 0.; 

static  shortint  cs _ 2  =  2; 

static  shortint  cs _ 3  =  3; 

/*  PROGRAM  EXOSIM  */ 

/* - 

~C  */ 

/*  -  Declare  and  initialize  variables  - 

-C  */ 

/*  - 

-C  */ 

/*  Main  program  */  MAIN _ () 

{ 

/*  Format  strings  */ 

Static  char  fmt^l55[]  =  " (lx, el6. 9, \002  DROP  NOSE  FAIRING  AND  BOOST 
ADAP\ 

TER\002) "; 

/*  System  generated  locals  */ 
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real  r_l; 

/*  Builtin  functions  */ 

integer  s_wsfi(),  do_fio(),  e_wsfi(); 

/*  Local  variables  */ 

static  real  delt; 

static  shortint  igit; 

static  real  eisp,  mass,  mdot,  quat[4]; 

extern  /*  Subroutine  */  int  spintegi_(> ; 

static  real  tmsudriv,  tmsustep,  p,  q,  r,  t,  u,  v,  w,  wbanf,  mdota, 
mxacs, 

myacs,  mzacs,  quatd[4]; 
static  shortint  imass,  idrop; 
static  real  dteps; 
static  shortint  iexit;' 

static  real  tdrop,  mdotv,  xmtof,  tstep,  mxvcs,  myves,  mzves,  tlmsu; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  wprop,  pd,  qd,  rd,  xd,  yd,  zd; 

static  shortint  nclear; 

static  real  tnx,  my,  mz,  tfinal,  weight; 

extern  /*  Subroutine  */  int  send_real_32bit _ (),  masspr_(); 

static  real  impuls,  wdotti; 

extern  /*  Subroutine  */  int  outmes_(); 

static  real  wdotkv,  wdottp; 

extern  /*  Subroutine  */  int  missil2_(>; 

static  real  cim[9],  phi; 

extern  /*  Subroutine  */  int  cw87_(); 

stat.ic  real  psi,  tht; 

static  char  message [128] ; 

static  real  vkv,  ixx,  iyy,  izz; 

extern  /*  Subroutine  */  int  spinteg_(),  receive_signed_16bit _ (); 

/*  Fortran  I/O  blocks  */ 

static  icilist  io _ 55  =  (  0,  message,  0,  fmt_155,  128,  1  ); 


/*  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
*/ 

/*  OUTPUTS  */ 

/*  NAMELIST  INPUTS  */ 

/*  DATA  INITIALIZATION  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA35.DAT’)  */ 

/*  $INCLUDE( '^/INCLUDE/SSDATA38.DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA39.DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA42.DAT')  */ 

/*  $  INCLUDE  ( '''/INCLUDE/SSDATA4  4.  DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA45.DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA46.DAT’)  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA47.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA48.DAT')  */ 

Z’'  $INCLUDE( '''/INCLUDE/SSDATA49.DAT’)  */ 

/*  $  INCLUDE  ( '''/INCLUDE/SSDATA50.  DAT')  */ 

/*  $INCLUDE( '-'/INCLUDE /SSDAT AO  1. DAT')  */ 

/*  SINCLUDE  (  ' ''/INCLUDE/SSDATA17  .DAT' )'  */ 

/*  $INCLUDE( '-'/INCLUDE/SSDATAIS.DAT')  */ 

/*  $INCLUDE( '-'/INCLUDE/SSD.!\TA21  .DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA22.DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA23.DAT')  */ 

/*  $INCLUDE('-'/INCLUDE/SSDATA28.DAT')  */ 

/*  $INCLUDE( '-'/INCLUDE/SSDATA29.DAT')  */ 

/*  $INCLUDE( '^/INCLUDE/SSDATA30.DAT')  */ 

/*  $INCLUDEC''/INCLUDE/SSDATA71  .DAT')  */ 
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/*  $INCLUDE(  •''/INCLUDE/SSTIMING.DAT')  */ 
/*  $INCLUDE{ 'SSpOO.DAT')  */ 

/*  INITIALIZE  80x87  */ 
cw87_{) ; 

/* 


- C  */ 

/* - main  execution  loop 

- C  */ 

/* 


- c  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Execucioir  of  all  events  is  performed 
within  this  loop 


- C  */ 

/*  call  initialize_tiraing 0  */ 

LIOOO: 

/*  call  start_timing (0)  */ 

/*  WRITE{*,*)' - BEGINNING  OF  LOOP '  */ 

/* 


- C  */ 

/*  -  MISSILE  STATE  UPDATE  MODULE 

- C  */ 

/* 


- C  */ 

/*  Integrate  missile  states  to  current  time 

C 
*/ 

/* 

C 

*/ 

/* 


— c  */ 

/* 

1001  format (lx, f7 , 4, 3 (a. 

lpel3.6))  */ 

/* 

1002  format (lx, 3 (a, lpel3 

.6))  */ 

/* 

write (message, 1001) t, 'p 

',p, '  q  ' f q^ '  r 

',r  */ 

/* 

call  outmes (message)  */ 

/* 

write (message, 1002) ' 

pd  ' , pd, '  qd 

' , qd, '  rd  ' , rd 

*/ 

/* 

call  outmes (message)  */ 

/* 

write (message, 1002) ' 

cim(l)  ',cim(l) ,  ' 

(2)  ’,cim(2). 

*/ 

/* 

* 

'  (3)  ' 

,cim(3)  */ 

/* 

call  outmes (message)  */ 

/* 

write (message, 1002) ' 

(4)  ',cim(4) , ' 

(5)  ',cim(5), 

*/ 

/* 

★ 

'  (6)  ' 

,cim(6)  */ 

/* 

call  outmes (message)  */ 

/* 

write (message, 1002) ' 

(7)  ',cim(7) ,  ' 

(8)  ',cim(8). 

*/ 

/* 

* 

'  (9)  ' 

f  CilTi  (  9 )  *  / 

/* 

call  outmes (message)  */ 

if  (tstep  >=  tmsudriv)  { 

tmsudriv  +=  tmsustep; 

/* 
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- C  */ 

/*  - PROPERTIES  MODULE 

- C  */ 

/* 


- C  */ 

/*  Update  mass  flow  rate,  eg  and  inertia 

C  */ 

/* 

C  */ 

/* 


- C  */ 

masspr_(st,  &mdota,  smdotv,  &mass,  &eisp,  simass,  &mdot,  sweight, 

& 

wdottp,  swdotkv,  Swdotti,  &ixx,  &iyy,  sizz)  ; 

/* 


- C  */ 

/*  -  VEHICLE  STATES  MODULE 

- C  */ 

/* 


- c  */ 

/* 

c  */ 

/* 

c  */ 

/  * 


Compute  missile  state  derivatives 


&mxvcs 

& 


- C  */ 

missil2_(St, 

/ 

fimyacs, 
qd,  srd 


quat,  cim,  &p, 
smyves,  ..'mzacs 
,  &mx,  &my,  &mz 


&q,  &r,  &ixx, 

,  Smzvcs,  &xd, 
,  &u,  &v,  &w, 


spsi)  ; 
i* 


&iyy, 

&yd, 

quatd, 


&izz,  &mxacs, 
&zd,  snclear, 
&phi,  &tht, 


fipd, 


- C  */ 

/* 

c  */ 

/* 


- c  */ 

/* 

derivatives  C  */ 
/* 

not  C  */ 

/* 

C  */ 

/* 

last  C  */ 

/* 

integration  C  */ 
/* 

coincide  C  */ 

/* 

/* 

c  */ 

/* 

c  */ 

/* 


MISSILE  STATE  INTEGRATION  MODULE 


Revise  missile  states  using 
just  computed  .  Missile  states  must 
be  integrated  if  a  table  lookup  index 
transition  has  occurred  since  the 
integration  step  .  The  next 
step  should  be  rescheduled  to 
with  the  earliest  detected  table 
index  transition  instead  .  Otherwise 
schedule  the  next  integration  step  to 
occur  at  the  default  step  size  . 
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C  */ 

/* 

C  */ 

/* 


/* 


/* 


/* 


— C  */ 

TRAPEZOIDAL  INTEGRATION  FOR  SIMPLICITY  */ 

spinteg_(&mass,  &mdot,  &t,  &cs _ 1) ; 

spinteg_(&wkv,  Swdotkv,  &t,  &cs 5) ; 

spinteg_(&p,  &pd,  &t,  &cs _ 12); 

spinteg_(&q,  &qd,  &t.-  &cs _ 13); 

spinteg_(&r,  &rd,  &t,  &cs _ 14); 

spinteg_(quat,,  quatd,  &t,  &cs _ 15); 

spinteg_ (squat (1] ,  &quatd[l],  &t,  &cs _ 16); 

spinteg_ (squat (2 ] ,  squatd(2],  St,  scs _ 17); 

spinteg_(squat [3] ,  SquatdiS],  St,  Scs _ 18); 

SAVE  TIME  OF  LAST  MISSILE  STATE  UPDATE  */ 
tlinsu  =  t; 


- C  */ 

/*  -  SEPARATION  MODULE 

- C  V 

/* 

- c  */ 

/*  Models  discontinuities  occuring  during 

C 
*/ 

/*  stage  separation 


C 

*! 

/* 

C 

*/ 

/* 


- C  *! 

/*  NOSE  FAIRING  /  BOOST  ADAPTER  SEPARATION  */ 

if  (idrop  ==  1  I  I  (r_l  =  t  -  tdrop,  dabs(r_l))  <=  dteps  ss  igit  =•- 

1)  { 

wkv  -=  wbanf; 
mass  =  wkv  /  xmtof; 
s_wsfi{Sio _ 55)  ; 

do_fio(Sc _ 1,  (char  *)St,  (ftnlen) sizeof (real) ) ; 

e_ws  f i ( ) ; 

outmes_ (message,  128L) ; 

/*  REINITIALIZE  PERTINENT  INTEGRALS  */ 

spintegi_(smass,  Sc_bl4,  St,  scs _ 1); 

spintegi_(Swprop,  Sc_bl4,  St,  scs _ 2) ; 

spintegi_(Simpuls,  Sc_bl4,  St,  scs _ 3) ; 

spintegi_(Swkv,  sc_bl4,  St,  scs _ 5) ; 

} 

/* 


- C  */ 

/* - 


Processor  communication 


- C  */ 

/*  call  switch_timing()  */ 

/* -  Communicate  with  pOl  - C  */ 
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send_real_32bit _ (&ixx) ; 

send_real_32bit _ (&iyy) ; 

send_real_32bit _ (&izz) ; 

send  real  32bit  (&mass) ; 


/* 

*/ 

-  Communicate  w; 

Lth 

p03 

send  real  32bit 

(&p)  ; 

send  real  32bit 

(&q)  ; 

send  real  32bit 

(&r)  ; 

/* 

CALL  RECEIVE 

REAL  64BIT{ 

d 

XD 

) 

*/ 

/* 

XD  =  d  XD  */ 

/* 

CALL  RECEIVE 

REAL  64BIT{ 

d 

YD 

) 

*/ 

/* 

YD  =  d  YD  */ 

/* 

CALL  RECEIVE 

REAL  64BIT( 

d 

ZD 

) 

*/ 

/*  ZD  =  d_ZD  */ 

receive_real_32bit _ (&xd)  ; 

receive_real_32bit _ (&yd) ; 

receive_real_32bit _ (&zd) ; 

send_real_32bit _ (cim) ; 

send_real_32bit _ (&cim[l] ) ; 

send_real_32bit _ (&cim(2] ) ; 

send_real_32bit _ (&cim[3] ) ; 

send_real_32bit _ (&cim[4] ) ; 

send_real_  32bit _ {&ciin[5] )  ; 

send_real2.32bit _ (&cim(6] )  ; 

send_real_32bit _ (&cimi7] ) ; 

send_real_32bit _ (&cim(8] ) ; 

/* -  Communicate  with  pOl  - C  */ 

receive_signed_16bit _ {&idrop) ; 

/* -  Receive  from  ACSTHR  and  VCSTHR  - C  */ 

receive_real_32bit _ (smdotv) ; 

receive_real_32bit _ (smdota) ; 

receive_real_32bit _ (Smxvcs) ; 

receive_real_32bit _ (smyves) ; 

receive  real  32bit  (&mzvcs) ; 

receive_real_32bit _ (smxacs) ; 

receive_real_32bit _ (&myacs)  ; 

receive_real_32bit _ (smzacs) ; 

send_rGal_32bit _ (&pd) ; 

send_real_32bit _ (&qd) ; 

send  real  32bit  (&rd) ; 


/*  call  switch  tim.ingO  */ 

/* 


- C  */ 

/*  -  OUTPUT  MODULE 

- C  */ 

/* 


- C  */ 

/*  Creates  print  and  plot  output  data 

C 
*/ 

/*  files 

C 


*/ 

/* 

C 

*/ 

/* 


- c  */ 

/*  call  stop_timing 0  */ 

/*  if  (  mod(int (tstep) , int (dtprt) ) .eq.O  )  then  */ 
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/*  call  output_timing ()  */ 

/*  call  initialize_timing 0  */ 

/*  ENDIF  */ 

/* 


- C  */ 

/* - TERMINATION  LOGIC 

- C  */ 

/* 


- C  */ 

/*  Defines  the  simulation  termination 

C 
*/ 

/*  conditions 

C 


*/ 

/* 

C 

*/ 

/* 


- C  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
*/ 

/*  EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED  */ 
if  (t  >=  tfinal)  { 
iexit  =  1; 

} 

/*  increment  time  */ 
tstep  +=  (float) 1 . ; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  ( 
goto  LIOOO; 

) 

outmes_( "ERROR:  Exit  from  POO",  20L) 

)  /*  MAIN  */ 
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B.3.2  UupOl.c 

/*  uupOl.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Common  Block  Declarations  */ 
struct  { 

shortint  first2; 
doublereal  tl2,  grtpst[3]; 

)  robtrg_; 

tdefine  robtrg_l  robtrg*_ 
struct  { 

doublereal  grlast(3],  tOnav; 
shortint  mnav; 

doublereal  dtxO,  deyO,  dtzO; 

}  rnavig_; 

#detine  rnavig_l  rnavig_ 

/*  PROGRAM  EXOSIM  */ 

/* - 

-C  */ 

/*  -  Declare  and  initialize  variables  - 

-C  */ 

/* - 

-c  */ 

/*  Main  program  */  MAIN _ () 

{ 

/*  System  generated  locals  */ 
real  r_l; 

doublereal  d_l,  d_2; 

/*  Local  variables  */ 
static  doublereal  delt,  delu; 

static  real  s_gr _ (3]; 

static  doublereal  del/,  delw; 
static  real  s_xd _ ,  s_yd _ ,  s_zd _ ; 

static  doublereal  rtic[15]  /*  was  [5] [3]  */,  mass,  rrel(3], 

vtic [15] 

/*  was  [5] [3]  */,  sphi,  vrel[3],  rmir[3],  vmir[3],  spsi,  stht; 

static  real  s_pulsea _ [3]; 

static  doublereal  xyze[3]; 
static  real  s_pulseg _ [3]; 

static  doublereal  timudriv,  tgpudriv,  timustep,  tgpustep,  t,  x,  y, 
z; 

extern  /*  Subroutine  */  int  navig_(); 
static  doublereal  dteps; 
static  shortint  iexit; 

static  doublereal  tstep,  rtest[3],  xyzed[3],  vtest[3]; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (), 

receive_real_64bit _ ( ) 

t 

static  doublereal  tuplkl,  tuplk2,  at  [3],  gr[3],  xd,  yd,  zd,  sp,  sq, 
sr, 

delphi,  su,  sv,  sw,  tfinal; 
extern  /*  Subroutine  */  int  obtarg_(); 
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static  doubiereai  aeipsi,  deitnt; 

static  real  s_mass _ ; 

static  doubiereai  pulsea[3]; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  doubiereai  pulseg[3],  grtest[3]; 
extern  /*  Subroutine  */  int  imupro_(); 
static  doubiereai  qsl[4]; 
extern  /*  Subroutine  * !  int  estrel2_() ; 
static  doubiereai  cie(9],  rmi[3]; 
extern  /*  Subroutine  */  int  cw87_(); 

static  doubiereai  vn\i[3],  grt[15]  /*  was  [5]  [3]  *!,  sud,  svd, 

swd,  ti2m[ 

9]; 

/*  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
*/ 

/*  OUTPUTS  */ 

/*  NAMELIST  INPUTS  */ 

/*  DATA  INITIALIZATION  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA35.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA38.DAT’)  */ 

/*  $  INCLUDE  {'''/INCLUDE/ SSDATA39.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA42.DAT')  */ 

/*  SINCLUDE  (' ''/INCLUDE/SSDATA44  .DAT' )  */ 

/*  SINCLUDE  ( ' ''/INCLUDE/SSDATA45.DAT' )  */ 

/*  $INCLUDE('''/INCIUDE/SSDATA46.DAT')  */ 

/*  $INCLUDE('''/INC..UDE/SSDATA47.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA48.DAT')  »/ 

/*  $INCLUDE{'^/INCLUDE/SSDATA49.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA50.DAT')  */ 

/*  SINCLUDEC -'/INCLUDE/SSDATAOl.DAT')  */ 

/•  s9tnCLUDE('''/INCLUDE/SSDATA17.DAT')  */ 

/*  $;NCLUDE('''/INCLUDE/SSDATA18.DAT')  */ 

/*  $  INCLUDE  ('''/INCLUDE/SSDATA21.  DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA22.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA23.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA28.DAT')  */ 

/*  $  INCLUDE  ('“'/INCLUDE/ SSDATA29.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA30.DAT')  */ 

/*  $  INCLUDE  ('''/INCLUDE/ SSDATA71.DAT')  */ 

/*  $INCLUDE('“'/INCLUDE/SSTIMING.DAT')  */ 

/*  $INCLUDE( 'SSp01.DAT')  */ 

/*  INITIALIZE  80x87  */ 
cw87_() ; 

/* 


- C  */ 

/* - MAIN  execution  LOOP 


/* 


- C  */ 

/*  Execution  of  all  events  is  performed 

C 
*/ 

/*  within  this  loop 


C 

*/ 

/* 

C 

*/ 

/* 
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- C  */ 

LIOOO: 

/*  WRITE(*,*)' - BEGINNING  OF  LOOP - '  */ 

/* 


- C  */ 

/*  -  Processor  communication 

- C  */ 

/* 


- C  V 

/* - COMMUNICATION  WITH  POO 

- C  */ 

receive_real_32bit _ {s_gr _ ) ; 

receive_real_32bit _ (&s_gr _ [1] ) ; 

receive_real_32bit _ (&s_gr _ [2] ) ; 

gr[0]  =  s_gr _ [0]; 

gr [1]  =  s_gr _ [1] ; 

gr[2]  =  s_gr _ [2]; 

receive_real_32bit _ (&s_mass _ ) ; 

mass  =  s_mass _ ; 

receive_real_32bit _ {s_pulsea _ ) ; 

pulsea[0]  =  s_pulsea _ [0]; 

receive_real_32bit _ (&s_pulsea _ [1] ) ; 

pulsea[l]  =  s_pulsea _ [1]; 

receive_real_32bit _ (&s_pulsea _ [2] )  ; 

pulsea[2]  =  s_pulsea _ [2]; 

receive_real_32bit _ (s_pulseg _ )  ; 

pulseg[0]  =  s_pulseg _ [0]; 

receive_real_32bit _ (&s_pulseg _ [1] )  ; 

pulsegd]  =  s_pulseg _ [1]; 

receive_real_32bit _ (&s_pulseg _ [2] ) ; 

pulseg[2]  =  s_pulseg _ [2]; 

receive_real_64bit _ (xyze) ; 

receive_real_64bit _ (&xyze(l]) ; 

receive_real_64bit _ Uxyze (2] ) ; 

receive_real_64bit _ (xyzed)  ; 

receive_real_64bit _ (&xyzed(l] )  ; 

receive_real_64bit _ (&xyzed[2i )  ; 

/*  -  COMMUNICATION  WITH  SEEKER 

- C  */ 

receive_real_64bit _ (&x) ; 

receive_real_64bit _ (&y) ; 

receive_real_64bit _ <&z)  ; 

receive_real_32bit _ (&s_xd _ ) ; 

receive_real_32bit _ (&s_yd _ )  ; 

receive_real_32bit _ (&s_zd _ ) ; 

xd  =  s_xd _ ; 

yd  =  s_yd _ ; 

zd  =  s_zd _ ; 

/*  -  COMMUNICATION  WITH  CORVEL 


C  */ 


r_l  =  rmir[0]; 

send_real_32bit _ 

(&r_ 

.1)  <• 

r_l  =  rmir[l]; 

send_real_32bit _ 

(&r_ 

.1)  '• 

r_l  =  rmir[2]; 

send  real  32bit 

(&r_ 

.1)  '• 

1 

II 

Ml 

O 

1 

send_real_32bit _ 

(&r_ 

.1)  '• 

r_l  =  vmir[l]; 

send_real_32bit _ 

{&r_ 

.1)  '• 

r_l  -  vmir[2]; 

send  real  32bit 

(&r 

1)  ; 
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receive_real_64bit _ (grt) ; 

receive_real_64bit _ (&grt[5])  ; 

receive_real_64bit _ (&grt [10] )  ; 

receive_real_64bit _ (rtic)  ; 

receive_real_64bit _ (Srtic [5] ) ; 

receive_real_64bit _ (&rticil01 ) ; 

receive_real_64bit _ (vtic)  ; 

receive_real_64bit _ (fivtic [5] )  ; 

receive_real_64bit _ (&vtic (10) ) ; 

/* - COMI4UNICATE  WITH  CORVEL - C  */ 

r_l  =  at  [0]  ; 

senci_r6'il_32bit _ (&r_l)  ; 

r_l  =  a^  [1]  ; 

send_real_32bit _ (&r_l) ; 

r__l  =  at[2]; 

senci_real_32bit _ (sr_l)  ; 

/* - DAISY  CHAIN  - C  */ 

r_l  =  ti2m[0] ; 

send_real_32bit _ {&r_l)  ; 

r_l  =  ti2m[l]  ; 

send_real_32bit _ (&i-_l)  ; 

r_l  =  ti2m[2]; 

send_real_32bit _ (&r_l) ; 

r_l  =  ti2m[3]; 

send_real_32bit _ (&r_l)  ; 

r_l  =  ti2m[4]; 

send_real_32bit _ (&r_l)  ; 

r_l  =  ti2m[5]; 

send_real_32bit _ (&r_l) ; 

r_l  =  ti2m[6]; 

send_real_32bit _ (&r_l) ; 

r_l  =  ti2m(7]; 

send_real_32bit _ (&r_l)  ; 

r_l  “  ti2in(8]; 

send_real_32bit _ (&r_l)  ; 

r_l  =  vrel[0]; 

send_real_32bit _ {&r_l) ; 

r_l  =  vrel[l]; 

send_real_32bit _ (&r_l)  ; 

r_l  =  vrel(2]; 

send_real_32bit _ (&r_l) ; 

r_l  =  rrel[0]; 

send_real_32bit _ (&r_l) ; 

r_l  =  rrel[l]; 

send_real_32bit _ (&r_l) ; 

r_l  =  rrel(2]; 

send_real_32bit _ (&r_l) ; 

r_l  =  sp; 

send_real_32bit _ {&r_l) ; 

r_l  =  sq; 

send_real_32bit _ (&r_l) ; 

r_l  =  sr; 

send  real  32bit  (&r  1)  ; 


- C  */ 

/*  -  INERTIAL  MEASUREMENT  UPDATE 

- C  */ 

/* 


- C  */ 

/*  Get  inertial  measurement  data  needed 

C 
*/ 
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/*  for  guiaance  caicuiacions  .. 

C 
*/ 

/* 

C 

*/ 

/* 


-C  */ 

if  (tstep  >=  timudriv)  { 
timudriv  +=  timustep; 


- C  */ 

/* - IMU  PROCESSOR  MODULE 

- C  */ 

/* 


- C  */ 

/* 

outputs  C  */ 
/* 

C  */ 

/* 

c  */ 

/* 


- c  */ 

imupro_(st,  pulseg,  pulsea,  sdelphi,  sdeltht,  &delpsi,  sdelu, 
sdelv,  & 

delw) ; 

/* 


- C  */ 

/*  -  NAVIGATION  MODULE 

. - . -C  */ 

/* 


Convert  gyro  and  accelerometer 
to  delta  angle  and  delta  velocity 


- C  */ 

/* 

quaternions  C  */ 
/* 

delta  C  */ 

/* 

calculatesC  */ 

/* 

C  */ 

/* 

C  */ 

/* 

C  */ 

/* 

C  */ 

/* 


This  module  calculates  the 

and  transformation  matrices  using 

angles  sensed  by  the  gyro  and 

the  interceptor  velocity  and  position 

using  delta  velocity  sensed  by  the 

accelerometer 


gr, 

& 

/* 


- C  */ 

navig_(&t,  &mass,  sdelphi,  Sdeltht,  sdelpsi,  sdelu,  sdelv,  sdelw, 
qsl,  cie,  ssp,  ssq,  ssr,  Scud,  Ssvd,  sswd,  vrar,  rmir,  ti2m, 
sphi,  Sstht,  sspsi,  Ssu,  Ssv,  Ssw,  at,  vmi,  rmi) ; 
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- C  V 

/*  -  MIDCOURSE  CORRECTION 

- - - C  */ 

/* 


- C  */ 

/* 

C 

*/ 

/* 

C 
*/ 
i  * 

c 

*/ 

/* 


Models  uplink  of  interceptor. 


target,  and  intercept  conditions 


- C  */ 

if  ((d_l  =  t  -  tuplkl,  abs(d_l))  <=  dteps  I  I  (d_2  =  t  -  tuplk2, 
abs (d_2) ) 

<=  dteps)  { 

/*  REVISE  ESTIMATED  MISSILE  STATES  */ 

vmi  [0]  =  xyzed[0] ; 
vmi [1]  =  xyzedil] ; 
vmi [2]  =  xyzedi2i ; 
rmiio]  =  xyze[0]; 
rmi [1]  =  xyze [1] ; 
rmi  [2]  =  xyze [2] ; 
vmir[0]  =  xd; 
vmiril]  =  yd; 
vmir[2i  =  zd; 
rmiriO]  =  x; 
rmiril]  =  y; 
rmir[2i  =  z; 
rnavig_l .tOnav  =  t; 

) 

/* 


- C  */ 

/*  -  MIDCOURSE  CORRECTION 

- - - C  */ 

/* 


- C  */ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 


Models  uplink  of  interceptor, 
target,  and  intercept  conditions 


- C  */ 

if  ( (d_l  =  t  -  tuplkl,  abs(d_l))  <=  dteps  II  (d_2  =  t  -  tuplk2, 
abs (d_2) ) 

<=  dteps)  { 

/*  REVISE  ESTIMATED  TARGET  STATES  ♦/ 

rtest  [0]  =  rtic [0] ; 
rtestil]  =  rticis]; 
rtest  [2]  =  rticilO]; 
vtestio]  =  vtic[0]; 
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vtest [1]  =  vtic[5] ; 
vtesti2]  =  vticilO]; 
grtest [0]  =  grt [0] ; 
grtest [1]  =  grt [5] ; 
grtest [2]  =  grtilO]; 
robtrg_l.tl2  =  t; 

) 

/* 


- C  */ 

/* 

c 

*/ 

/* 


- c  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


ON  BOARD  GUIDANCE  PROCESSING 


Determine  guidance  commands 


- C  */ 

if  (tstep  >=  tgpudriv)  { 
tgpudriv  +-  tgpustep; 

/* 


- C  */ 

/*  -  ON  BOARD  TARGET  MODULE 

. . C  */ 

/* 


- C  */ 

/*  Estimate  target  position  based  on 

C  */ 

/*  predicted  intercept  conditions 

C  */ 

/* 

C  */ 

/* 


- C  */ 

/*  GRTEST  TEMPORARILY  EQUAL  TO  GRT  */ 

grtest [0]  =  grt(0]; 
grtest  [1]  =  grt (5] ; 
grtest  [2]  =  grt  [10]; 
obtarg_(&t,  grtest,  rtest,  vtest); 
estrel2_(rtest,  vtest,  rmir,  vrair,  rrel,  vrel) ; 


- C  */ 

/* - 


TERMINATION  LOGIC 


■C  */ 


/* 

Defines  the  simulation  termination 

c 

*/ 

/* 

conditions 

C 
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*/ 

/* 

C 

*/ 

/* 


- c  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 

*/ 

/*  EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED  */ 
if  (t  >=  tfinal)  { 
iexit  =  1; 

} 

/*  increment  time  */ 
tstep  +=  1 . ; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  { 
goto  LIOOO; 

) 

1  /*  MAIN  */ 
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Uup02.c 

/*  UL;.02.f  —  translated  by  f2c  (versitn  of  3  February  1990  3:36:42). 

Yu'-  .;ust  link  the  resulting  object  file  with  the  libraries: 

-1FV7  -1177  -Im  -Ic  (in  that  order) 

*/ 


finclude  "f2c.h" 

/*  Common  Brock  Declarations  */ 


struct  1 

real  t::efl tlstv,  tmvcs(24]  /*  was  (6]  [4]  */,  thvcs(24]  /* 
was  [6]  [4]  */; 
short int  lenvcs [4] ; 

)  rvcstr_; 

♦define  rvcstr  1  rvcstr 


/*  PROCIAM  ZVOSIM  */ 

/*  - 

-C  */ 

/* - Declare  and  initialize  va’-iables  - 

-C  */ 

/*  - 

-C  */ 

/*  Main  program  */  MAIN _ () 

{ 

static  real  delt,  tbrk; 
static  shortint  ivcs; 

static  real  foffl(4],  foff2(4],  tmsudriv,  tmsustep,  t; 
static  shortint  ivtab; 
static  real  tvtab; 
static  shortint  iexit; 

static  real  mdotv,  fxvcs,  fyvcs,  fzvcs,  tstep,  mxvcs,  myvcs,  mzvcs, 
tkvon; 


/* 

*/ 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/* 

/■^ 

/* 

/* 

/* 

/* 


extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  eg (3],  dtoffv(4]; 

extern  /*  Subroutine  */  int  send_real_32bit _ {),: 

static  real  tofflt(4],  tburnm; 
extern  /*  Subroutine  */  int  vcsthr_(); 
static  real  timonv; 

extern  /*  Subroutine  */  int  cw87_(),  receive_signed_16bit _ () ; 

THE  FOLLOWING  COMMON  BLOCK  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

DATA  INITIALIZATION  */ 

$INCLUDE( '  ''/INCLUDE/SSDATA35.DAT')  */ 

$INCLUDE(  '''/INCLUDE/SSDATA38.DAT')  */ 

$  INCLUDE  { ' ''  /  INCLUDE/ SSDATA3  9 .  DAT ' )  *  / 

$  INCLUDE  (  ' ''/ INCLUDE /SSDATA4  2  .DAT' )  */ 

$  INCLUDE  ( '  -'/ INCLUDE /SSDATA4  4  .DAT' )  */ 

$INCLUDE(  ''■/INCLUDE/SSDATA45.DAT')  */ 

$INCLUDE(  '''/INCLUDE/SSDATA46.DAT')  */ 

SINCLUDE ( ' "/INCLUDE/SSDATA47 .DAT ' )  */ 

$  INCLUDE  INCLUDE/ SSDATA4  8  .  DAT  ' )  *  / 

SINCLUDE  {  '  ''/INCLUDE/SSDATA49  .DAT  ' )  */ 

$INCLUDE{  '•■■/INCLUUE/SSDATA50.DAT')  */ 

$  INCLUDE  (  '  '^  /  INCLUDE/ SSDATAOl  .DAT  ' )  */ 

$  INCLUDE  ( '  ''/ INCLUDE /SSDATAl  7  .DAT' )  */ 

SINCLUDE ( ' "/INCLUDE/SSDATA18 .DAT' )  */ 

$  INCLUDE  (  '  '-/ INCLUDE/ SSDATA21  .DAT  ' )  */ 
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/'  $INCLUDE{'"/INCLUDE/SSDATA22.nAT')  */ 
/*  $INCLUDE('''/INCLUDE/SSDATA23.DAT')  */ 
/*  $  INCLUDE  ('''/INCLUEE/ SSDATA28.DAT')  */ 
/*  $  INCLUDE  (■''/INCLUDE/ SSDATA29.DAT')  */ 
/*  $INCLUDE(' ^/INCLUDE/ SSDATA30.DAT')  */ 
/*  $  INCLUDE  (■''/INCLUDE/ CSDATA71.DAT')  */ 
/*  $INCLUDE(  ■''/INCLUDE/SSTIMING.DAT^  )  */ 
/*  $INCLUDE(^SSp02.DAT^)  */ 

/*  INITIALIZE  80x87  */ 
cw87_() ; 

/* 


- C  */ 

/* - main  execution  loop 

- c  */ 

/* 


- c  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Execution  of  all  events  is  performed 
within  this  loop 


- C  */ 

LIOOO: 

/*  WRITE(*,*)^ - BEGINNING  OF  LOOP - ■  */ 

/* 


. C  */ 

/*  -  MISSILE  STATE  UPDATE  MODULE 

- - C  */ 

/* 


- c  */ 

/*  Integrate  missile  states  to  current  time 

C 
*/ 

/* 

C 

*/ 

/* 


- c  */ 

/* - V3  from  masspr  (POO)  - C  */ 

receive_rec;’.__32bit _ (eg)  ; 

receive__re? l"’32bit _ (&cg[l] )  ; 

receive__rwal^32bit _ (&cg  [2] )  ; 

^/* - Send  variables  to  masspr  and  missil  (pOO) 

- - C  */ 

send_real_32bit _ (Smdotv) ; 

send_real_32bit _ (sfxvcs) ; 

send_real_32bit (sfyves)  ; 

3end_real_32bit (sfrves)  ; 

send_real_32bit _ (smxvcs) ; 

send_real_32bit _ (smyves) ; 

send_real_3?bit _ (Smzvcs) 

/* - Communication  wich  pOl  - C  */ 

receive  real  32bit  (dtoffv) ; 
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receive_real_32bit _ (&dtoffv(l] ) 

receive_real_32bit _ Udtoffv[2] ) 

receive_real_32bit _ (&dtoffv[3] ) 

rGceive_signed_16bit _ (sivcs) ; 

receive_signed_16bit _ (fiivtab) ; 

receive_real_32bit _ (Stburnm)  ; 

receive_real_32bit _ Utimonv)  ; 

receive_real_32bit _ (tofflt) ; 

receive_real_32bit _ (stofflt [1] ) 

receive_real_32bit _ (Stofflt [2] ) 

receive_real_32bit _ (Stofflt [3] ) 

receive_real_32bit _ (Stvtab) ; 

if  (tstep  >=  tmsudriv)  { 
tmsudriv  +=  tmsustep; 


- C  */ 

/*  -  VCS  THRUSTER  RESPONSE  MODULE 

- C  */ 

/* 


- C  */ 

/*  Determines  the  forces  and  moments 

C  */ 

/*  imparted  by  the  VCS  thrusters 

C  */ 

/* 

C  */ 

/* 


. C  */ 

if  (t  >=  tkvon)  { 

vcsthr_(St,  eg,  Stburnm,  sives,  tofflt,  stimonv,  dtoffv, 

Stvtab, 

foffl,  foff2,  sivtab,  stbrk,  Sfxvcs,  sfyvcs,  Sfzvcs,  s 
mxvcs,  smyves,  smzvcs,  smdotv) ; 

) 

) 

/* 


- C  */ 

/  it 
/ 


TERMINATION  LOGIC 


- C  */ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 

c 

*/ 

/* 


Defines  the  simulation  termination 


conditions 


- C  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =0; 

/*  increment  time  */ 
tstep  +=  (float)!.; 
t  =  tstep  *  delt; 
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/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 

*/ 

if  (iexit  ==  0)  { 
goto  LIOOO; 

} 

}  /*  MAIN _  */ 

/*  uup02.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

#include  "f2c.h" 

/*  Common  Block  Declarations  */ 


struct  { 

real  treflv,  tlstv,  tmvcs[24]  /*  was  [6] [4]  */,  thvcs[24]  /* 
was  [6] [4]  */; 
shortint  lenves  [4]  ; 

}  rvcstr_; 

#define  rvcstr  1  rvcstr 


/*  PROGRAM  EXOSIM  */ 

/*  - 

-c  V 

/*  -  Declare  and  initialize  variables  - 

-C  */ 

I*  - 

-c  */ 

/*  Main  program  */  MAIN _ () 

{ 

static  real  delt,  tbrk; 
static  shortint  ives; 

static  real  foffl[4],  foff2[4],  tmsudriv,  tmsustep,  t; 
static  shortint  ivtab; 
static  real  tvtab; 
static  shortint  iexit; 

static  real  mdotv,  fxvcs,  fyves,  fzves,  tstep,  mxvcs,  myves,  mzves, 
tkvon; 


extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  cg[3],  dtoffv[4]; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  real  tofflt[4],  tburnm; 
extern  /*  Subroutine  */  int  vcsthr_(); 
static  real  timonv; 

extern  /*  Subroutine  */  int  cw87_(),  receive_signed_16bit _ (); 


/*  THE  FOLLOWING  COMMON  BLOCK  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
*/ 

/*  DATA  INITIALIZATION  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA35.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA38.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA39.DAT') 

/*  $INCLUDE('"/INCLUDE/SSDATA42.DAT')  */ 

/*  $INCLUDE  ( ' ''/INCLUDE/SSDATA44  .DAT' )  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA45.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA46.DAT’)  */ 

/*  $INCLUDE('^/INCLUDE/SSDATA47.DAT')  */ 

/*  $INCLUDE('"/INCLUDE/SSDATA48.DAT')  */ 

/*  $INCLUDE( '"/INCLUDE/SSDATA49.DAT' )  *•/ 
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/*  $INCLUDE('"/INCLUDE/SSDATA50.DAT') 

/*  $INCLUDE('''/INCLUDE/SSDATA01.DAT')  */ 
/*  $INCLUDE{'''/INCLUDE/SSDATA17.DAT')  */ 
/*  $INCLUDE('"/INCLUDE/SSDATA18.DAT')  */ 
/*  $INCLUDE('''/INCLUDE/SSDATA21.DAT')  */ 
/*  $INCLUDE( '-'/INCLUDE / SSDATA22.DAT')  */ 
/*  $INCLUDE{'^/INCLUDE/SSDATA23.DAT')  */ 
/*  $INCLUDE('''/INCLUDE/SSDATA28.DAT')  */ 
/*  $INCLUDE( '-'/INCLUDE /SSDATA2 9. DAT')  */ 
/*  $INCLUDE('''/INCLUDE/SSDATA30.DAT')  */ 
/*  $INCLUDE('''/INCLUDE/SSDATA71..nAT')  */ 
/*  $INCLUDE( '-'/INCLUDE/SSTIMING.DAT')  */ 
/*  $ INCLUDE ('SSp02.DAT')  */ 

/*  INITIALIZE  60x87  */ 
cw87  {)  ; 

/* 


- C  */ 

/x - EXECUTION  LOOP 

- C  */ 

/* 


- c  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Execution  of  all  events  is  performed 


within  this  loop 


- C  */ 

LIOOO: 

/*  WRITE(*,*)' - BEGINNING  OF  LOOP - '  */ 

/* 


- C  */ 

/* - 


/* 


- C  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


c  */ 


MISSILE  STATE  UPDATE  MODULE 


Integrate  missile  states  to  current  time 


- C  */ 

/* - recieve  from  masspr  (POO)  - C  */ 

receive_real_32bit _ (eg) ; 

receive_real_32bit _ (&cg[l] ) ; 

receive_real_32bit _ (&cg[2i) ; 

/* - Send  variables  to  masspr  and  missil  (pOO) 

- C  */ 

send_real_32bit _ (Smdotv) ; 

send_real_32bit _ (&fxvcs) ; 

send_real_32bit _ (Sfyves) ; 

send_real  32bit  (Sfzvcs)  ; 
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senci_real_32bit _ (iirj'.vcs)  ; 

ser^d_real_32bit _ (&myvcs)  ; 

send_real_32bit _ (Smzvcs) ; 

/* - Communication  with  pOl - C  */ 

receive_real_32bil  ___{dtoffv)  ; 
receive  real  32biu _ '(Sdtof fv['  ! ) ; 

receive_real_32bit _ (&dtoffv(2j  > ; 

receive_real_32bit _ (&dtoffv[3i ; 

receive_signed_16bit _ (sives) ; 

receive_signed_16bit _ (&ivtab)  ; 

receive_real_32bit _ (&tburnm)  ; 

receive_real_32bit _ (Stimonv) ; 

receive_real_32bit _ (toff It) ; 

receive_real_32bit _ (stofflt (1] )  ; 

receive_real_32bit _ (&tofflt [2] ) ; 

receive_real_32bit _ (stofflt  [3] )  ; 

receive_real_32bit _ (Stvtab)  ; 

if  (tstep  >=  tmsudriv)  { 
tmsudriv  +=  tmsustep; 


- c 

/* 

- c 

/* 

C  */ 

/* 

C  */ 

/* 

C  */ 

/* 


ves  THRUSTER  RESPONSE  MODULE 


Determines  the  forces  and  moments 
imparted  by  the  VCS  thrusters 


- C  */ 

if  (t  >=  t)cvon)  ( 

vcsthr_{&t,  eg,  &tburnm,  &ivcs,  tofflt,  stimonv,  dtoffv, 

stvtab, 

foffl,  foff2,  sivtab,  stbrk,  Sfxvcs,  sfyvcs,  sfzvcs,  s 
mxvcs,  Smyves,  smzvcs,  Smdotv) ; 

} 

) 

/* 


- C  */ 

/* - 


TERtvIINATION  LOGIC 


- C  */ 

/* 

C 

*/ 

/* 

C 

*/ 

/" 

C 

*/ 

/* 


Defines  the  simulation  termination 


conditions 


- C  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 
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iexit  =  0; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  { 
goto  LIOOO; 

) 

}  /*  MAIN  */ 
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B.3.4  Uup03.c 

/*  uupOS.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


finclude  "f2c.h" 

/*  Common  Block  Declarations  */ 
struct  { 

doublereal  til,  grtlst[15]  /*  was  [5]  [3]  */; 

shortint  firstl; 

}  rtarg_; 

tdefine  rtarg_l  rtarg_ 

/*  Table  of  constant  values  */ 

static  real  c_b2  =  (float) 0.; 

static  shortint  cs _ 1  =  1; 

static  shortint  cs _ 2  =  2; 

static  shortint  cs _ 3  =  3; 

static  integer  c _ 1  =  1; 

/*  PROGRAM  EXOSIM  */ 

/* - 

-C  */ 

/*  -  Declare  and  initialize  variables 

-C  */ 

/* - - - 

-C  V 

/*  Main  program  */  MAIN _ () 

{ 


/*  Format  strings  */ 

static  char  fmt_889[]  =  " (lx,el6 . 9, \002  MISS  =  \002,el6. 9) 

/*  System  generated  locals  */ 
real  r_l; 

doublereal  d_l,  d_2,  d_3; 

/*  Builtin  functions  */ 
double  sqrtO; 

integer  s_wsfi(),  do_fio(),  e_wsfi(); 

/*  Local  variables  */ 

static  doublereal  delt,  rtic[15]  /*  was  [5]  [3]  */; 

static  real  tphi; 

static  doublereal  latt,  rtar[3],  miss; 
static  real  tpsi; 

static  doublereal  rte‘.  [3],  vtar[3]; 
static  real  ttht; 

static  doublereal  vtic[15]  /*  was  [5] [3]  */; 

extern  /*  Subroutine  */  int  send_signed_16bit _ (); 

static  doublereal  tmsudriv,  trsudriv,  ttsudriv,  tmsustep,  trsustep, 
ttsustep; 
static  real  q,  r; 
static  doublereal  t,  x,  y,  z; 
static  real  tphid,  ptarg,  qtarg,  rtarg,  tpsid; 
static  doublereal  longt; 
static  real  tthtd; 


418 


Appendix  B  -  Exositn  v2.0  Midcourse  and  Terminial  Phases 


static  doublereal  rrelmO],  vrelm[3],  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (), 

receive_real_64bit _ ( ) 

,  spmrak_(),  relat_()  ; 

static  doublereal  tgotr,  xmiss,  ymiss,  zmiss; 
static  shortint  iexit; 
static  doublereal  tgomn; 
static  real  xd,  yd,  zd; 

static  doublereal  lamsek[2],  lamdsk[2],  maglos,  lamdtr[2],  magrtr, 
ingrdtr, 

lamdxx[2],  lamtru[2],  rreltr[3],  vreltr[3],  rj[5]; 

extern  /*  Subroutine  */  int  send_real_64bit _ (); 

static  shortint  ireslv; 

extern  /*  Subroutine  */  int  3(snd_real_32bit _ (); 

static  doublereal  cie[9],  OT.egae; 

extern  /*  Subroutine  */  int  target_(;,  oucmes_(); 

static  real  cim[9],  cer[9],  cit[9],  cti[9]; 

static  doublereal  cms(9],  grt[15}  /*  was  [5]  [3]  */; 

static  char  message [128] ; 

extern  /*  Subroutine  */  int  cw87_(); 

/*  Fortran  I/O  blocks  *! 

static  icilist  io _ 68  =  {  0,  message,  0,  fmt_889,  128,  1  }; 


/*  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
*/ 

/*  OUTPUTS  */ 

/*  NAMELIST  INPUTS  */ 

/*  DATA  INITIALIZATION  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA35.DAT')  */ 

/*  $  INCLUDE  (•''/INCLUDE/ SSDATA38.DAT')  */ 

/*  $INCLUDE('^/INCLUDE/SSDATA39.DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA42.DAT')  */ 

/*  SINCLUDEC"/ INCLUDE/SSDATA44.DAT')  */ 

/*  $INCLUDE('''/TNCLUDE/SSDATA45.DAT')  */ 

/*  $  INCLUDE  ('''/INCLUDE/SSDATA4  6.  DAT')  */ 

/*  $INCLUDE( ' ''/INCLUDE/SSDATA47  .DAT' )  */ 

/*  $  INCLUDE  ('''/INCLUDE/SSDATA4  8.  DAT')  */ 

/*  $INCLUDE{'^/INCLUDE/SSDATA49.DAT')  */ 

/*  $INCLUDE('"/INCLUDE/SSDATA50.DAT')  */ 

/*  $INCLUDE(  •''/INCLUDE/SSDATAOl.DAT')  */ 

/*  $  INCLUDE  (•''/INCLUDE/ SSDATA17.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA18.DAT')  */ 

/*  $INCLUDE( ' ''/INCLUDE/SSDATA21  .DAT' )  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA22.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA23.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA28.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA29.DAT')  */ 

/*  $INCLUDE('^/INCLUDE/SSDATA.:O.DAT')  */ 

/*  $  INCLUDE  (•''/INCLUDE/SSD  ATA71.DAT')  */ 

/*  $  INCLUDE  (•''/INCLUDE/ SSTIMING.DAT')  */ 

/*  SINCLUDEC  ■/INCLUDE/SSMAS_cg.DAT' )  */ 

/*  INITIALIZE  80x87  */ 
cw87  0  ; 

/*  $ INCLUDE ('SSp03.DAT')  */ 

/* 


- C  */ 

/*  - execution  loop 

- C  */ 

/* 
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- C  */ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 


- C  */ 

LIOOO: 

/* 


- C  */ 

/* - 


Execution  of  all  events  is  performed 
within  this  loop 


-  Processor  communication 

C  */ 


- C  */ 

/* -  Communicate  with  pOO - C 

*/ 

receive_real_32bit _ {&q)  ; 

receive_real_32bit _ (&r)  ; 

receive_real_64bit _ (&x)  ; 

receive_real_64bit _ (&y)  ; 

receive_real_64bit _ (&z) ; 

receive_real_32bit _ ^(&xd)  ; 

receive_real_32bit _ (&ya) ; 

receive_real_32bit _ (&zd) ; 

receive~real_32bit _ (cim)  ; 

receive_real_32bit _ (&cim[l] )  ; 

receive_real_32bit _ Ucimi2] ) ; 

receive_real_32bit _ (&cimi3i )  ; 

receive_real_32bit _ (scimUl ) ; 

receive_real_32bit _ (&cim[5] )  ; 

receive_real_32bit _ (&cimi6] )  ; 

receive_real_32bit _ Ucimi7] ) ; 

receive_real_32bit _ (scimisj ) ; 

/* -  Communicate  with  pOl - 

C 

*/ 

send_real_64bit _ (grt) ; 

send_real_64bit _ (&grt [5] ) ; 

send_real_64bit _ (&grt [10] ) ; 

send_signed_16bit _ (sireslv) ; 

r_l  =  lamdxx[0]; 

send_real_32bit _ (&r_l) ; 

r_l  =  lamdxx[l]; 

send_real_32bit _ (&r_l) ; 

r_l  =  lamsek[0]; 

send_real_32bit _ (&r_l) ; 

r_l  =  lamsek [ 1 ] ; 

send_real_32bit _ (&r_l) ; 

r_l  =  magrtr; 

send_real_32bit _ {&r_l) ; 

send_real_64bit _ (rtic) ; 

send_reai_64bit _ (&rtic lb] ) ; 

send_real_64bit _ (&rtic [10] ) ; 

send_real_64bit _ (vtic) ; 

send_real_64bit _ (&vtic[5] ) ; 

send  real  64bit  (&vtic[10]); 
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/*  write;*,’')' - BEGINNING  OF  LOOP - ’  */ 

if  (tstep  >=  tmsudriv)  { 
tmsudriv  +=  tmsustep; 

/*  ROTATING  EARTH  MODEL  */ 

r_l  =  omegae  *  t; 

spmmk_(&c_b2,  &cs _ 1,  &c_b2,  &cs _ 2,  &r_l,  &cs_  3,  cer) ; 

} 

/* 


- C  */ 

'*  -  RELATIVE  STATES  MODULE 

- C  */ 

/* 


- C  */ 

/* 

C 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Calculate  relative  range,  range  rate, 
time-tc-go,  LOS  angles  and  rates 


/* 


/* 

/’* 

/* 


/* 


C  */ 


if  (tstep  >=  trsudriv)  { 
trsudriv  +=  trsustep; 

relat_(rtic,  vtic,  &x,  &y,  &z,  &xd,  &yd,  &zd,  &q,  &r,  cim,  ems, 
rreltr,  smagrtr,  vreltr,  &mgrdtr,  &maglos,  lamtru,  lamd:  ., 
lamdtr,  lamsek,  lamdsk,  &tgotr,  rrelm,  vrelm) ; 

EXTRAPOLATE  POINT  OF  CLOSEST  APPROACH  */ 


xmiss  ■=  rreltr  £0]  +  tgotr  * 
ymiss  =  rreltrfl]  +  tgotr  * 
zmiss  =  rreltr [2]  +  tgotr  * 
Computing  2nd  power  */ 
d_l  =  xmiss; 

Computing  2nd  power  */ 
d_2  =  ymiss; 

Computing  2nd  power  */ 
d_3  =  zmiss; 

miss  =  sqrt (d_l  *  d_l  +  d_2 


vreltr [0]  ; 
vreltr  [1] ;' 
vreltr [2] ; 


*  d  2  +  d  3 


*  d  3); 


- C  */ 

/*  -  TARGET  STATES  MODULE 

- C  */ 

/* 


/* 

C 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 


This  module  calculates  the  true  exo- 
atmospheric  trajectory  data  for 


the  target 
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/* 


- C  */ 

if  (tstep  >=  ttsudriv)  { 
ttsudriv  +=  ttsustep; 

target_(&t,  fimagrtr,  cer,  cie,  sptarg,  &qtarg,  Srtarg,  stphi, 
sttht,  & 

tpsi,  gr'-.,  stphid,  &tthtd,  &tpsid,  cit,  rtic,  vtic,  rtar, 
rter,  sireslv,  rj,  cti,  vtar,  &latt,  slongt) ; 

) 

/* 


- C  */ 

/* - TERMINATION  LOGIC 


/* 


- C  */ 

/*  Defines  the  simulation  termination 

C 
*/ 

/*  conditions 


C 

*/ 

/* 

C 

*/ 

/* 


- C  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 
iexit  =  0; 

/*  ENABLE  EXIT  IF  INTERCEPT  HAS  OCCURRED  AND  ALL  EVENTS  SCHEDULED 
FOR 
*/ 

/*  THIS  TIME  HAVE  BEEN  EXECUTED  */ 
if  (tgotr  <=  tgomn)  { 
iexit  =  1; 

} 

/*  increment  time  */ 
tstep  +=  1 . ; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  { 
goto  LIOOO; 

} 

/* 


- C  */ 

/*  -  POINT  OF  CLOSEST  APPROACH  CALCULATION 

— C  */ 

/* 


- C  */ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 

c 


Determines  the  miss  distance  at  the 
point  of  closest  approach 
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*/ 

/* 


- C  */ 

/*  Computing  2nd  power  */ 

d_l  =  rreltr{03  +  vreltr[0]  *  tgotr; 

/*  Computing  2nd  power  */ 

d_2  =  rreltrtl]  +  vreltr(l]  *  tgotr; 

/*  Computing  2nd  power  */ 

d_3  =  rreltr[2]  +  vreltr[2]  *  tgotr; 

miss  =  sqrt{d_l  *  d_l  +  d_2  *  djl  +  d_3  *  d_3) ; 

s_wsfi  {&io _ 68)  ; 

<io_fio(&c _ 1,  (char  *)&t,  (ftnlen) sizeof (doublereal) ) ; 

do_fio(&c _ 1,  (char  *)&miss,  (ftnlen) sizeof (doublereal) ) ; 

e_wsfi 0  ; 

outmes_ (message,  128L) ; 

}  /*  MAIN  */ 
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B.3.5  Uup04.c 

/*  uup04,f  —  translated  by  f2c  {version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

#include  "f2c.h" 

/*  Common  Block  Declarations  */ 


struct  { 

doublereal  gset; 
shortint  iset; 

}  norcom_; 

#define  norcom_l  norcom_ 
struct  { 

real  ranseq[97],  ranlst; 
}  rancom_; 

fdefine  rancom  1  rancom 


struct  ( 

doublereal  psig,  thtg,  phig,  thxzg,  thxyg,  thyzg, 
thzxg, 


wbo2  [ 


sflg[3],  sf2g[3],  dcg[3],  tOgyro,  cimo[9], 
3],  wbol[3],  drsigg; 


}  rgyro_; 


thyxg, 
wbi2  [3] 


thzyg, 
wbil [3] , 


tdefine  rgyro_l  rgyro_ 


/*  PROGRAM  EXOSIM  */ 

/* - - - - — - - 

-C  */ 

/*  -  Declare  and  initialize  variables 

-C  */  . 

/* - 

-C  */ 

/*  Main  program  */  MAIN _ () 

{ 

/*  System  generated  locals  */ 
real  r  1; 


/*  Local  variables  */ 

static  doublereal  delt; 

extern  /*  Subroutine  */  int  gyro_(); 

static  doublereal  timudriv,  timustep,  p,  q,  r,  t; 

static  real  s_cim _ [9]; 

static  shortint  iexit; 
static  doublereal  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ 0; 

static  doublereal  qfracg[3]; 
static  integer  gyseed; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  doublereal  pulseg[3],  cim[9]; 

static  real  s  p  ,  s  q  ,  s_r _ ; 

extern  /*  Subroutine  */  int  cw87  (); 


/*  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 

V 
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/* 

DATA  INITIALIZATION  */ 

/* 

$include 

( '  ''/include/ssdata35  .dat ' ) 

*/ 

/* 

$include 

( '  ''/include/ssdata38  .dat ' ) 

V 

/* 

$include 

{ '  ''/include/ssdata39  .dat ' ) 

*/ 

/* 

$include 

( '  ''/include/ssdata42  .dat ' ) 

/* 

$include 

( '  ''/include/ssdata44  .dat ' ) 

*/ 

/* 

$ include 

{ ' "/include/ssdata45 .dat ' ) 

*/ 

/* 

$include 

( '  ''/include/ssdata4  6.dat ' ) 

*/ 

/* 

$include 

■' '  ''/include/ssdata47  .dat ' ) 

*/ 

/* 

$include 

( '  ''/include/ssdata48  .dat ' ) 

*/ 

/* 

$include 

( '  ''/include/ssdata49.dat ' ) 

*  ' 

/ 

/* 

$include 

( '  ''/include/ssdataSO  .dat ' ) 

'/ 

/* 

$include 

( '  ''/include/ssdataOl  .dat ' ) 

*/ 

/* 

$include 

( '  ''/include/ssdatal7  .dat ' ) 

*/ 

/* 

$ include 

( '  ''/include/ssdatal8  .dat ' ) 

*/ 

/* 

$ include 

( '  ''/include/ssdata21  .dat ' ) 

*/ 

/* 

^include 

( ' ^/include/ssdata22 .dat ' ) 

*/ 

/* 

$include 

( '  ''/include/ssdata23  .dat  * ) 

*/ 

/* 

$ include 

( '  ''/include/ssdata28  .dat ' ) 

*/ 

/* 

$include 

( '  ''/include/ssdata29  .dat ' ) 

*/ 

/* 

$include 

{ '  ''/include/ssdata30  .dat ' ) 

*! 

/* 

$include 

{ '  ''/include/ssda‘-a71  .dat ' ) 

*/ 

/* 

$include 

( '  ''/include/sstiming.dat ' ) 

*/ 

cw87_ ( ) ; 

/* 

$include 

{'ssp04.dat')  */ 

/* 


- C  */ 

/* - main  execution  loop 

. . C  */ 

I* 


. C  V 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


- c  */ 

LIOOO: 

/*  WRITE(*,*)' - BEGINNING  OF  LOOP - '  *! 

/* 


- C  */ 

/* - 


/* 


- C  */ 

/*  -  Communicate  with  pOl 

- C  */ 

r_1  =  pulseg[0]; 

send_real_32bit _ ; 

r_l  =  pulseg[l] ; 

send_real_32bit _ (&r_l) ; 

r_l  =  pulseg[2]; 

send  real  32bit  {&r  1); 


-  Processor  communication 

■C  */ 


Execution  of  all  events  is  performed 
within  this  loop 
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receive_reai_32bit _ (&s_p _ ) ; 

receive_real_32bit _ {&s_q _ ) ; 

receive_real_32bit _ {&s_r _ ) ; 

p  =  (doublereal)  s_p _ ; 

q  =  (doublereal)  s  q 

r  =  (doublereal)  s_r _ ; 

receive_real_32bit _ (s_cim _ )  ; 

receive_real_32bit _ (ss_cim _ (1] ) 

receive  real  32bit  ~(&s  cim _ [2] ) 

receive_real_32bit _ (&s_cim _ [3] ) 

receive_real_32bit _ (&s_cim _ (4) ) 

receive_real_32bit _ (&s_cim _ [5] ) 

receive_real_32bit _ (&s_cim _ [6] ) 

receive_real_32bit _ (&s_cim _ (7] ) 

receive_real_32bit _ (&s_cim _ (8] ) 

cim[0]  =  (doublereal)  s_cim _ [o] 

cim[l]  =  (doublereal)  s_cim _ [1] 

cim[2]  =  (doublereal)  s_cim _ [2] 

cim [3]  =  (doublereal)  s_cim _ [3] 

cim [4]  =  (doublereal)  s_cim _ [4] 

cimfS]  =  (doublereal)  s_cim _ [5] 

cimC6]  =  (doublereal)  s_cim _ (63 

cim[7i  =  (doublereal)  s_cim _ [7] 

cim[8]  =  (doublereal)  s  cim _ [8] 


- C  V 

/*  -  INERTIAL  MEASUREMENT  UPDATE 

- C  */ 

/* 


■C  *! 


/* 

Gst 

c 

*/ 

/* 

for 

c 

*/ 

/* 

c 

*/ 

/* 

inertial  measurement  data  needed 
guidance  calculations  . 


- C  >/ 

if  (tstep  >=  timudriv)  { 
timudriv  +=  timustep; 

/* 


- C  */ 

/* - 


GYRO  MODULE 


- C  */ 

/*  Determine  sensed  body  rates  . 

C  */ 

/* 

C  */ 

/* 


- C  */ 

gyro_(&t,  &p,  &q,  &r,  cim,  &gyseed,  qfracg,  pulseg) ; 

} 

I* 
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- c  */ 

/*  - TERMINATION  LOGIC 


/* 


- C  */ 

/*  Defines  the  simulation  termination 

C 
*/ 

/*  conditions 


C 

*/ 

/* 

C 

*/ 

/* 


- C  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  increment  time  */ 
tstep  +=  1.; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  { 
goto  LIOOO; 

} 

}  /*  MAIN  */ 
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B.3.6  UupOS.c 

/*  uupOS.f  —  translated  by  f2c  (version  of  3  February  1990  3‘36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

finclude  "f2c.h" 

/*  Common  Block  Declarations  */ 

struct  { 

real  gset; 
shortint  iset; 

)  norcom_; 

#define  norcom_l  norcom_ 
struct  ( 

real  ranseq[97],  ranlst; 

)  rancom_; 

Idefine  rancom_l  rancom_ 
struct  { 

real  trefla,  tlstc,  acsf,  aoffl[4],  aoff2[4j,  traacsa[323  /*  was 

[8] [4j 

*/,  thacsa[32]  /*  was  [8]  [4]  */; 

shortint  lena[4]; 

real  tmacsb[32]  /*  was  [8]  [4]  */,  thacsb[32]  /*  was  [83(4]  */; 

shortint  lenb[43; 

}  racstr_; 

Idefine  racstr_l  racstr_ 

/*  PROGRAM  EXOSIM  */ 

/*  - 

-C  */ 

/*  -  Declare'  and  initialize  variables  - 

-C  */ 

/*  - 

-C  */ 

/*  Main  program  */  MAIN _ () 

{ 

static  real  delt,  tbrk; 

extern  /*  Subroutine  */  int  send_signed_16bit _ (); 

static  real  tmsudriv,  tmsustep,  t,  tatab,  mdota,  fxacs,  fyacs, 
fzacs, 

mxacs,  myacs,  mzacs; 
static  shortint  iexit; 
static  real  tstep,  tkvon; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  cg[33/  dtacsa(43,  dtacsb[43; 

static  shortint  iacson; 

static  real  acslev; 

static  integer  toseed; 

extern  /*  Subroutine  */  int  acsthr_(); 

static  real  timona; 

extern  /*  Subroutine  */  int  send_real_32bit _ 0; 

static  shortint  ithres; 

extern  /*  Subroutine  */  int  cw87_(),  receive_signed_l 6bit _ (); 
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/*  THE  FOLLOWING  COMMON  BLOCK  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
*/ 

/*  DATA  INITIALIZATION  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA35.DAT')  */ 

/*  $INCLUDE( '"/"NCLUDE/SSDATA38.DAT')  */ 

/*  SINCLUDE ( '  ■7INCLUDE/SSDATA39.DAT’ )  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA42.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA44.DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA45.DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA46.DAT')  */ 

/*  $  INCLUDE  {•''/INCLUDE/ SSDATA47.DAT')  */ 

/*  $INCLUDE( '^/INCLUDE/SSDATA48.DAT')  */ 

/*  $INCLUDE(  •''/INCLUDE / SSDATA4  9.DAT')  */ 

/*  $INCLUDE(  •''/INCLUDE  /  SSDATA50.DAT  •)  */ 

/*  $INCLUDE(  •''/INCLUDE/SSDATAOl.DAT^)  */ 

/*  $INCLUDE(  • ''/INCLUDE/SSDATA17  .DAT^ )  */ 

/*  $INCLUDE(  • ''/INCLUDE /SSDATAl 8  .DAT • )  */ 

/*  $INCLUDE( •^/INCLUDE/SSDATA21.DAT^)  */ 

/*  $INCLUDE(^''/INCLUDE/SSDATA22.DAT^)  */ 

/*  $INCLUDE(  •''/INCLUDE/SSDATA23.DAT^)  */ 

/’'  $INCLUDE(^''/INCLUDE/SSDATA28.DAT^)  */ 

/*  $  INCLUDE  (•''/INCLUDE/SSDATA2  9.  DAT  •)  */ 

/*  $INCLUDE(^''/INCLUDE/SSDATA30.DAT^)  */ 

/*  $INCLUDE(^''/INCLUDE/SSDATA71.DAT^)  */ 

/*  !?INCLUDE(  •^/INCLUDE  /  SSTIMING.DAT  •)  */ 

/*  INITIALIZE  80x87  */ 
cw87_()  ; 

/*  DETERMINE  IF  MIDFLIGHT  RESTART  */ 

/*  $INCLUDE( •SSp05.DAT •)  */ 

/* 


- C  */ 

/* - main  EXECUTION  LOOP 

— . - . C  */ 

/* 


- c  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Execution  of  all  events  is  performed 
within  this  loop 


- C  */ 

LIOOO: 

/*  WRITE(*,*)^ - BEGINNING  OF  LOOP 

/* 


- C  */ 

/* - 


/* 


- C  »/ 

/* 

c 

*/ 

/* 

c 


c  V 


MISSILE  STATE  UPDATE  MODULE 


Integrate  missile  states  to  current  time 
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*/ 

/* 


- C  */ 

/* - tecieve  from  masspr  (POO)  - C  */ 

receive_real_32bit _ (eg)  ; 

receive_real_32bit _ (&cg  Ll] ) ; 

receive_real_32bit _ (4ccg(2] )  ; 

/* - Send  variables  to  masspr  and  missil  (pOO) 

- C  */ 

send_real_32bit _ (Smdota)  ; 

send_real_32bit _ (&fxacs) ; 

send_real_32bit _ (Sfyacs) ; 

send_real_32bit _ (sfzacs)  ; 

send_real_32bit _ (fimxacs) ; 

send_real_32bit _ (Smyacs) ; 

send_real_32bit _ (&mzacs) ; 

/* - Communication  with  pOl - C  */ 

receive_reaL_32bit _ (fiacslev) ; 

receive_real_32bit _ (dtaesa)  ; 

receive_real_32bit _ (&dtacsa [1] )  ; 

receive_real_32bit _ (&dtacsai2] ) ; 

receive_real_32bit _ (&dtacsa(3] )  ; 

receive_real_32bit _ (dtacsb) ; 

receive_real_32bit _ (&dtacsb[l] )  ; 

receive_real_32bit _ (&dtacsb[2] ) ; 

receive_real_32bit _ (&dtacsb[3] ) ; 

receive_signed_.'.  (rbit _ ( &ithres ) ; 

receive_real_32bit _ (Statab) ; 

send  signed  16bit  {&iacson) ; 

/* - 


*/ 

if  (tstep  >=  tmsudriv)  { 
tmsudriv  +=  tmsustep; 
if  (t  >=  tkvon)  i 

/* 


— . . C  */ 

/*  -  ACS  THRUSTER  RESPONSE  MODULE 

- C  */ 

/* 


- C  */ 

/*  Determines  the  forces  and  moments 

C  */ 

/*  imparted  by  the  ACS  thrusters 

C  */ 

/* 

C  */ 

/* 


&tbrk,  & 
& 


/* 


- C  */ 

acsthr_{&t,  eg,  sacslev,  dtaesa,  dtacsb,  &tatab,  fitoseed, 

ithres,  sfxacs,  fifyacs,  &fzacs,  &mxacs,  fimyacs,  smzacs, 
mdota,  Siacson,  stimona) ; 


- C  */ 

/*  - TERMINATION  LOGIC 
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/* 


■C  V 


- c  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Defines  the  simulation  termination 

conditions 


- C  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  increment  time  */ 
tstep  +=  (float) 1 . ; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 


if  (iexit  ==  0)  { 
goto  LIOOO; 

} 

}  /*  MAIN  */ 
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B.3.7  Uup06.c 

I*  uupOS.f  —  translat€fCl  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  linl;  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

V 

#include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  shortint  cs _ 20  =  20; 

/*  PROGRAM  EXOSIM  */ 

/*  - 

-C  */ 

/*  -  -  Declare  and  initialize  variables  - 

-C  */ 

/* - 

-C  */ 

/*  Main  program  */  MAIN _ () 

{ 

static  real  delt,  mass,  tmsudriv,  tmsustep,  t; 
static  shortint  iexit; 
static  real  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ () ; 

static  real  masstl[20],  eg [3],  dt; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  shortint  icg; 

static  real  cgx[20],  cgy(20],  cgzt20]; 

extern  /*  Subroutine  */  int  cw87_(>,  sptable_(); 

/*  DATA  INITIALIZATION  */ 

/*  $INCLUDE('''/INCLUDE/SSMAS_cg.DAT')  */ 

/*  INITIALIZE  80x87  */ 

Cw87_()  ; 

/*  RESTARTING  FROM  MIDFLIGHT  DATA  FILE  */ 

/*  $ INCLUDE ( 'SSp06.DAT' )  */ 

I* 


- C  */ 

/*  - main  EXECUTION  LOOP 

- C  */ 

/* 


- C  */ 

/*  Execution  of  all  events  is  performed 

C 
*/ 

/*  within  this  loop 


C 

*/ 

/* 

C 

*/ 

/* 


. C  */ 

LIOOO: 

/*  WRITE{*,*)' - BEGINNING  OF  LOOP - '  */ 

/* 


C  */ 
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/*  -  MISSILE  STATE  UPDATE  MODULE 

- C  */ 

/* 


- c  */ 

/*  Integrate  missile  states  to  current  time 


C 

*/ 

/* 

C 

*/ 

/* 


- c  */ 

if  (tstep  >=  tmsudriv)  { 
tmsudriv  +=  tmsustep; 
dt  =  tmsustep  *  delt; 

/* 


- C  */ 

/*  -  mass  properties  module 

- C  */ 

/* 


- c  */ 

/*  Update  eg 

C  */ 

/* 

C  */ 

/* 


- C  */ 

/*  CALCULATE  MISSILE  CENTER  OF  GRAVITY  COMPONENTS  */ 

sptable_{masstl,  cgx,  smass,  eg,  &os _ 20,  &icg) ; 

sptable_{masstl,  egy,  smass,  scg[l],  &cs 20,  &icg) ; 

sptable~(itasstl,  cgz,  smass,  scgi2],  scs 20,  sieg)  ; 

) 

/* 


- C  */ 

/*  -  Processor  communication 

- C  */ 

/* 


- C  */ 

/*  -  communication  with  missil  model  */ 

receive_real_32bit _ (Smass) ; 

/*  -  send  to  ACSTHR  and  VCSTHR  and  ACCEL  */ 


send_real_32bit  _(cg) ; 

send_real_32bii. _ (Scg[l])  ; 

send  real  32bit  (Scg(2]); 

/* 


- C  */ 

/*  -  OUTPUT  MODULE 

- C  */ 

/* 


- C  */ 

/*  Creates  print  and  plot  output  data 

C 
*/ 

/*  files 

C 
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*/ 

/* 

C 

*/ 

/* 


- c  */ 

/*  if  (  modddnint  (tstep) ,  idnint  (dtprt)  )  .eq.  0  )  then  */ 

/*  ENDIF  */ 

/* 


- C  */ 

/*  - TERMINATION  LOGIC 

- C  */ 

/* 


- C  */ 

/*  Defines  the  simulation  termination 

C 
*/ 

/*  conditions 

C 


*/ 

/* 

c 

*/ 

/* 


- c  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  ( 
goto  LIOOO; 

) 

}  /*  MAIN  */ 
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B.3.8  Uup07.c 

/*  uup07.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Ira  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  PROGRAM  EXOSIM  */ 

/*  - 

-C  */ 

/*  -  Declare  and  initialize  variables  - 

-C  */ 

/*  - 

-C  */ 

/*  - 

-C  */ 

/*  Main  program  */  MAIN _ () 

{ 

/*  System  generated  locals  */ 
real  r_l,  r_2; 

/*  Builtin  functions  */ 
double  r_nint ( ) ; 

/*  Local  variables  */ 

static  real  tffe,  delt,  ttfe,  rmir[3],  vmir[3],  vttp[3],  timudriv, 
tgpudriv,  dtmpl,  timustep,  tgpustep,  t,  x,  y,  z,  dteps; 
static  shortint  iexit; 
static  real  dtcvu,  tcorv,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  tuplkl,  tuplk2,  at  [3],  dt,  vc[3]/  xd,  vg[33,  yd,  zd, 
vs [3], 

t final; 

extern  /*  Subroutine  */  int  corvel_(),  send_real_32bit _ (); 

static  real  dtspvc,  dlv[3]; 

extern  /*  Subroutine  */  int  cw87_(); 

static  real  ttf,  mvr,  mvs,  vtt(3],  uvs[3]; 

/*  DATA  INITIALIZATION  */ 

!'  $INCLUDE('''/INCLUDE/SSDATA35.DAT')  */ 

/*  $INCLUDE('"/INCLUDE/SSDATA38.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA39.DAT')  */ 

/*  $INCLUDE('^/INCLUDE/SSDATA42.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA44.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA45.DAT')  */ 

/*  $  INCLUDE  ('''/INCLUDE/ SSDATA4  6.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA47.DAT')  */ 

/*  SINCLUDE ( ' ^/INCLUDE/SSDATA48 .DAT ' )  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA49.DAT')  */ 

/*  SINCLUDEC^/INCLUDE/SSDATASO.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA01.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA17.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA18.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA21.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA22.DAT')  */ 

/*  $TNCLUDE('''/I.NCLUDE/SSD.ATA23.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA28.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA29.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA30.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA71.DAT')  */ 

/*  $  INCLUDE  (•''/INCLUDE/SSTIMING.  DAT')  */ 
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/*  INITIALIZE  80x87  */ 
cw87_()  ; 

/*  $INCLUDE  ( 'SSp07..DAT' )  */ 
/* 


- C  */ 

/* - main  execution  loop 

- C  */ 

/* 


- c  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Execution  of  all  events  is  performed 
within  this  loop 


- C  */ 

/*  CALL  INITIALIZE_TIMING()  */ 

LIOOO: 

/*  CALL  START_TIMING(0)  */ 

/*  WRITE(*,*)' - BEGINNING  OF  LOOP - '  */ 

/* 


- C  */ 

/* - 


Processor  communication 


- C  */ 

/*  CALL  SWITCH_TIMING()  */ 

/* - COMMUNICATION  WITH  POO 

- C  */ 

receive_real_32bit _ (&x) ; 

receive_real_32bit _ (&y) ; 

receive_real_32bit _ (&z) ; 

receive_real_32bit _ (&xd) ; 

receive_real_32bit _ (&yd) ; 

receive_real_32bit _ (&zd) ; 

receive_real_32bit _ (rmir) ; 

receive_real_32bit _ (&rmir [1] ) ; 

receive_real_32bit _ {&rmir [2] ) ; 

receive_real_32bit _ (vmir)  ; 

receive_real_32bit _ (Svmir [1] ) ; 

receive_real_32bit _ (Svmir [2] ) ; 

/* - COMMUNICATION  WITH  POl 

- C  */ 

receive_real_32bit _ (at) ; 

receive_real_32bit _ (&at[l]) ; 

receive_real_32bit _ (&at [2] ) ; 

send_real_32bit _ (vg) ; 

send_real_32bit _ (&vg[l]) ; 

send_real_32bit _ {&vg[2i ) ; 

/*  CALL  SWITCH_TIMING()  */ 

/* 


- C  */ 

/*  -  INERTIAL  MEASUREMENT  UPDATE 

- C  */ 
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/* 

- C  */ 


/* 

Get 

c 

*/ 

/* 

for 

c 

*/ 

/* 

c 

*/ 

/* 

inertial  measurement  data  needed 
guidance  calculations  . 


- C  */ 

if  (tstep  >=  timudriv)  { 
timudriv  +=  timustep; 

/*  TIME  SINCE  LAST  INERTIAL  MEASUREMENT  UPDATE  */ 

dt  =  timustep  *  delt; 

/*  INTEGRATE  GRAVITY  COMPENSATED  ACCELERATION  */ 

vtt[0]  +=  dt  *  at[0]; 
vtt[l]  +=  dt  *  at[l]; 
vtt  [2]  +=  dt  *  at  [2]  ; 

} 

/* 


- C  */ 

/*  -  MIDCOURSE  CORRECTION 

- C  */ 

/* 


- C  */ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 

c 

*/ 

/* 


Models  uplink  of  interceptor, 


target,  and  intercept  conditions 


- C  */ 

if  {(r_l  =  t  -  tuplkl,  dabs(r_l))  <=  dteps  II  (r_2  =  t  -  tuplk2, 
dabs (r_2) 

)  <=  dteps)  { 

/*  REVISE  ESTIMATED  MISSILE  STATES  */ 

vmir[0]  =  xd; 
vmiril]  =  yd; 
vmiri2i  =  zd; 
rmiriO]  =  x; 
rmir[l]  =  y; 
rmir(2]  =  z; 

) 

/* 


/* 

C 

*/ 

/* 


ON  BOARD  GUIDANCE  PROCESSING 


- C  */ 
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/*  Determine  guidance  commands 

C 
*/ 

/* 

C 

*/ 

/* 


- C  */ 

if  (tstep  >=  tgpudriv)  { 
tgpudriv  +=  tgpustep; 

/* 


- C  */ 

/*  -  CORRELATED  VELOCITY  MODULE 

- C  */ 

/* 


- C  */ 

/*  This  section  calculates  the 

correlated  C  */ 

/*  velocity  vector  (VC)  through  an  iter- 

C  */ 

/*  ative  process.  From  VC,  the  steering 

C  */ 

/*  velocity  vector  is  produced  by  sub- 

C  */ 

/*  tracting  a  bias  velocity  (VDO)  from 

the  C  */ 

/*  velocity  to  be  gained  (VG) . 

C  */ 

/* 

C  */ 

/* 


VC, 


— C  */ 

if  (t  >=  tcorv  &&  t  <=  f  -  dtspvc)  { 
corvel_(&t,  &mvr,  vui,,  rmir,  vmir, 

dlv,  Stffe,  &ttfe); 
r_l  =  (t  +  dtcvu)  /  dtcvu; 
dtmpl  =  dtcvu  *  r_nint (&r_l) ; 
tcorv  =  dtmpl; 


vttp. 


vg. 


vs. 


&mvs,  uvs. 


/* 


) 


- C  */ 

/*  -  OUTPUT  MODULE 

- C  */ 

/* 


- C  */ 

/*  call  stop_timing 0  */ 

/*  if  (  ;aod(int (tstep) , int (dtprt) ) .eq.O  )  then  */ 

/*  call  outpi  ._timing()  */ 

/*  call  INITIALIZE_TIMING()  */ 

/*  ENDIF  */ 

/* 


- C  */ 

/* - TERMINATION  LOGIC 

- C  */ 

/* 
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- C  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Defines  the  simulation  termination 


conditions 


- C  *! 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
*/ 

/*  EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED  */ 
if  (t  >=  tfinal)  { 
iexit  =  1; 

) 

/*  increment  time  */ 
tstep  +=  1 . ; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  {iexit  ==  0)  ( 
goto  LIOOO; 

) 

)  /*  MAIN  */ 
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B.3.9  UupOS.c 

/*  uupOS.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

#include  "f2c.h" 

/*  Common  Block  Declarations  */ 
struct  { 

doublereal  xint[50],  tint [50],  xdotltSO]; 

)  storag_; 

#define  storag_l  storag_ 
struct  { 

doublereal  xyzlch[3]; 

)  rmissl_; 

#define  rmissl_l  rmissl_ 

/*  Table  of  constant  values  */ 

static  shortint  cs _ 6  =  6; 

static  shortint  cs _ 7  =  7; 

static  shortint  cs _ 8  =  8; 

static  shortint  cs _ 9  =  9; 

static  shortint  cs _ 10  =  10; 

static  shortint  cs _ 11  =  11; 

static  doublereal  c_b8  =  0 . ; 

static  shortint  cs _ 1  =  1; 

static  shortint  cs _ 2  =  2; 

static  shortint  cs _ 3  =  3; 

static  integer  c _ 1  =  1; 

/*  PROGRAM  EXOSIM  */ 

/* - - - 

-C  */ 

/*  -  Declare  and  initialize  variables  - 

-C  */ 

/*  - 

-C  */ 

/* - 

-C  */ 

I*  Main  program  */  MAIN _ () 

{ 


/*  Format  strings  */ 

static  char  fmt_202(]  =  " (lx, f 8 . 4, 4el4 . 7) "; 

/*  System  generated  locals  */ 
real  r_l; 

doublereal  d_l,  d_2,  d_3; 

/*  Builtin  functions  */ 
double  sqrtO,  atan2(); 
integer  s_wsfi(),  do_fio(),  e_wsfi(); 

/*  Local  variables  */ 

static  doublereal  r-ade,  delt,  long_,  mass,  xyze[3],  xyzr[3], 
tmsudriv. 
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tmsustep,  t,  X,  y; 
static  real  s_cim _ [9]; 

static  doublereal  z,  xyzed[3],  tstep,  fxacs,  fxvcs,  fyacs,  fyves, 
f zacs, 

fzves; 

extern  /*  Subroutine  */  int  integ_(); 
static  doublereal  tlmsu; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  doublereal  dtprt; 
static  shortint  iexit; 
static  doublereal  gb[5],  gr[3]; 

static  real  s_mass _ ; 

static  doublereal  mxyzdd,  xyzedd(3]; 
extern  /*  Subroutine  */  int  missil_(); 
static  shortint  nclear; 

static  doublereal  ud,  vd,  wd,  fx,  cie(9],  fy,  fz,  xd,  yd,  zd, 
cim[9],  cer[ 

9],  cir[9],  lat,  mgr,  cri(9]; 
static  char  message [128] ; 

static  real  s_fxacs _ ,  s_fyacs _ ,  s_fzacs _ ,  s_fxvcs _ ,  s_fyvcs _ , 

s_f  zves _ ; 

extern  /*  Subroutine  */  int  cw87_{); 
static  dcublereal  xdd,  ydd,  zdd; 
extern  /*  Subroutine  */  int  mmk_(); 
static  doublereal  omegae,  dtr,  alt; 

extern  /*  Subroutine  */  int  send_real_32bit _ (), 

send_real_64bit _ ()  ; 

static  shortint  iprint; 

extern  /*  Subroutine  */  int  outmes_(); 

static  doublereal  tfinal; 

/*  Fortran  I/O  blocks  */ 

static  icilist  io _ 63  =  {  0,  message,  0,  fmt_202,  128,  1  }; 


/*  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
*/ 

/*  OUTPUTS  */ 

/*  NAMELIST  INPUTS  */ 

/*  DATA  INITIALIZATION  */ 

/*  $INCLUDE{'''/INCLUDE/SSDATA35.DAT')  */ 

/*  $INCLUDE(«''/INCLUDE/SSDATA38.DAT')  */ 

/*  $INCLUDE( '^/INCLUDE/SSDATA39.DAT')  */ 

/*  $INCLUDE{"'/INCLUDE/SSDATA42.DAT')  */ 

/*  $  INCLUDE  ('''/INCLUDE/SSDATA4  4.  DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA45.DAT')  */ 

/*  $  INCLUDE  { '''/INCLUDE/SSDATA4  6.  DAT')  */ 

/*  $INCLUDE{  ' ''/INCLUDE/SSDATA47  .DAT' )  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA48.DAT')  */ 

/*  $INCLUDF<'''/INCLUDE/SSDATA49.DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA50.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA01.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA17.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA18.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA21.DAT')  */ 

/*  $INCLUDE('"/INCLUDE/SSDATA22.DAT')  */ 

/*  $  INCLUDE  ('-'/INCLUDE/ SSDATA23.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/GSDATA28.DAT')  */ 

/*  $INCLUDE('^/INCLUDE/SSDATA29.DAT')  */ 

/*  $INCLUDE( '-'/INCLUDE/SSDATASO.DAT')  */ 

/*  $  INCLUDE  ('-'/INCLUDE/SSDATA71.  DAT')  */ 

/*  SINCLUDEC-'/INCLUDE/SSTIMING.DAT')  */ 

/*  $INCLUDE('^/INCLUDE/SSMAS_cg.DAT-)  */ 
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/*  INITIALIZE  80x87  */ 
cw87_() ; 

/*  $ INCLUDE ('SSp08.DAT')  */ 
/* 


- C  */ 

/* - main  execution  loop 

- c  */ 

/* 


- c  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Execution  of  all  events  is  performed 


within  this  loop 


- C  */ 

LIOOO: 

/*  WRITE(*,*)' - BEGINNING  OF  LOOP - '  */ 

/* 


- C  */ 

/*  -  MISSILE  STATE  UPDATE  MODULE 

. . C  */ 

/* 


- C  */ 

/*  Integrate  missile  states  to  current  time 

C 
*/ 

/* 

C 

*/ 

/* 


- C  */ 

if  (tstep  >=  tmsudriv)  { 
tmsudriv  +=  tmsustep; 

/* 


-c  */ 

/ 

/* 

— 

— c  */ 

/* 

c  V 

/* 

c  */ 

/* 

r'ompute  missile  state  derivatives 

&fx, 

/* 


- C  */ 

missil_(&t,  cim, 
fzves,  &x, 


&fy,  &fz, 


Smass,  ifxacs,  sfxvcs,  sfyacs, 
&y,  &z,  &nclear,  &ud,  &vd,  &wd, 

&xdd,  &ydd,  &zdd,  smxyzdd) ; 


&fyvcs,  sfzacs, 
gb,  gr,  &mgr, 


& 
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- C  */ 

/*  MISSILE  STATE  INTEGRATION  MODULE 

C  */ 

/* 


- C  */ 

/* 

derivatives  C  */ 
/* 

not  C  */ 

/* 

C  */ 

/* 

last  C  */ 

/* 

integration  C  */ 
/* 

coincide  C  */ 

/* 

lookup  C  */ 

/* 

C  */ 

/* 

C  */ 

/* 

C  */ 

/* 

C  */ 

/* 


- . — c  */ 

/*  TRAPEZOIDAL  INTEGRATION  FOR  SIMPLICITY  */ 

integ_(&xd,  &xdd,  &t,  &cs _ 6) ; 

integ_(&yd,  &ydd,  &t,  scs _ i) : 

integ~(&2d,  szdd,  &t,  &cs _ 8); 

integ~(&x,  &xd,  &t,  &cs _ 9) ; 

integ_(&y,  &yd,  &t,  &cs _ 10); 

integ_(&z,  &zd,  St,  &cs _ 11); 

/*  TRANSFORM  INERTIAL  POSITION  AND  VELOCITY  TO  EARTH  FRAME  */ 

xyzelO]  =  cie[0]  *  x  +  cie[3]  *  y  +  cie[6]  *  z; 

xyzefl]  =  cieil]  *  :.  +  cie[4)  *  y  +  cie[7]  *  z; 

xyze[2]  =  cieiz]  *  x  +  cieis]  *  y  +  ciefS]  *  z; 

xyzed[0]  =  cie[0]  *  xd  +  cie(3]  *  yd  +  cie[6]  *  zd; 

xyzedil]  =  cie[l]  *  xd  +  cie(4]  *  yd  +  cieiv]  *  zd; 

xyzed[2]  =  cie[2]  *  xd  +  cie[5]  *  yd  +  cie[8]  *  zd; 

xyzedd[0]  =  cie(0]  *  xdd  +  cie[33  *  ydd  +  cie[6]  *  zdd; 

xyzedd[l]  =  cieil]  *  xdd  +  ciei4]  *  ydd  +  ciei?]  *  zdd; 

xyzeddi2]  =  cieiz]  *  xdd  +  cieis]  *  ydd  +  cieiS]  *  zdd; 

/*  ROTATING  EARTH  MODEL  */ 

d_l  =  omegae  *  t; 

mmk_(&c_b8,  &cs _ 1,  &c_b8,  scs _ 2,  &d_l,  &cs _ 3,  cer)  ; 

xyzr[0]  =  cer[0]  *  xyze[0]  +  cer(3]  *  xyze[l]  +  cer[6]  *  xyze[2]; 


xyzr [1] 

=  cer[l] 

*  xyzefO] 

+  cer [4] 

*  xyze[l] 

+  cer [7] 

*  xyze 

xyzr [2] 

=  cer[2] 

*  xyzeio] 

+  cerfs] 

*  xyze[l] 

+  cer[8] 

*  xyze 

cir  [0] 

=  cer[0] 

★ 

cie [0] 

+ 

cer  [3] 

★ 

cie  [1] 

+ 

cer [6] 

k 

cie  [  2 ] ; 

cir [l] 

=  cer[l] 

★ 

cie [0] 

+ 

cer [4] 

* 

cie  [1] 

+ 

cer [7] 

k 

cie  [2] ; 

cir [2] 

=  cer[2] 

★ 

cie [0] 

+ 

cer [5] 

* 

cic[l] 

+ 

cer [8] 

k 

cie [2] ; 

cir [3] 

=  ceriO] 

★ 

cie  13J 

+ 

cer [3] 

k 

cie (4] 

+ 

cer [6] 

k 

cie [5] ; 

cir[4] 

=  cer[li 

•k 

cie[3] 

+ 

cer  [4] 

k 

cie [4] 

+ 

cer  [7] 

k 

cie  iS  ] ; 

cir [5] 

=  ceriz] 

•k 

cie [3] 

+ 

cer [5] 

k 

cie  [4] 

+ 

cer [8] 

* 

cie  [5] ; 

cir [6] 

=  cerfo] 

k 

cie [6] 

+ 

cer [3] 

k 

cie  [7] 

+ 

cer [6] 

k 

cie [8] ; 

cir[7] 

=  cer(l] 

k 

cie [6] 

+ 

cer (4] 

k 

cie  [7] 

+ 

cer  [7] 

k 

cie  iS] ; 

cir [8] 

=  cer[2] 

k 

cie [6] 

+ 

cer [5] 

k 

cie  [7] 

+ 

eerie] 

k 

cie  i  8] ; 

Revise  missile  states  using 
just  conputed  .  Missile  states  must 
be  integrated  if  a  table  lookup  index 
transition  has  occurred  since  the 
integration  step  .  The  next 
step  should  be  resclieduled  to 
with  the  earliest  detected  table 
index  transition  instead  .  Otherwise 
schedule  the  next  integration  step  to 
occur  at  the  default  step  size  . 
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cri  [0]  ==  cir  [0]  ; 
crifl]  =  cir[33 ; 
cri  [2]  =  cir [6] ; 
cri [3]  =  cir [1] ; 
cri [4]  =  cir [4] ; 
cri [5]  =  cir [7] ; 
cri [6]  =  cir [2] ; 
cri  [7]  =  cir [5] ; 
cri  (8]  =  cir  [8] ; 

/*  CALCULATE  CURRENT  LATITUDE  AND  LONGITUDE  */ 

/*  Computing  2nd  power  */ 
d_l  =  xyzr[0]; 

/*  Computing  2nd  power  */ 
d_2  =  xyzr[l]; 

lat  =  atan2 (xyzr [2] ,  (sqrt(d_l  *  d_l  +  d_2  *  d_2)))  /  dtr; 
long_  =  atan2 (xyzr [1] ,  xyzr(0])  /  dtr; 

/*  CALCULATE  CURRENT  MISSILE  ALTITUDE  */ 

/*  Computing  2nd  power  */ 
d_l  =  x; 

/*  Computing  2nd  power  */ 
d_2  =  y; 

/*  Computing  2nd  power  */ 
d_3  =  z; 

alt  =  sqrt (d_l  ”  d_l  +  d_2  *  d_2  +  d_3  *  d_3)  -  rade; 

/*  SAVE  TIME  OF  LAST  MISSILE  STATE  UPDATE  */ 

tlmsu  =  t; 

} 

/* 


- C  */ 

/*  -  Processor  communication 

- C  */ 

/* 


- C  */ 

/* -  Communicate  with  pOl  - C  */ 

r_l  =  gr  [0]  ; 

send_real_32bit _ (&r_l) ; 

r_l  =  gr ( 1 ] ; 

send_real_32bit _ {&r_l) ; 

r_l  =  gr [2] ; 

send_real__3?bit _ (&r_l)  ; 

receive_real_32bit _ (&s_mas3 _ ) ; 

mass  =  s_mass _ ; 

send_real_64bit _ (xyze)  ; 

send_real_64bit _ (&xyze[l] ) ; 

send_real_64bit _ (&xyze(2] )  ; 

send_real_64bit _ (xyzed) ; 

send_real_64bit _ (&xyzed[l] ) ; 

send_real_64bit _ (&xyzed[2] ) ; 

/* -  Communicate  with  p03 - C 

*/ 

send_real__64bit _ (&x)  ; 

send_real”64bit _ (Sy) ; 

send_real_64bit _ (Sz) ; 

r_l  =  x; 

send_real_32bit _ (&r_l) ; 

r__l  =  y; 

send_real _32bit _ {&r_l) ; 

r_l  =  z; 

send_real_32bit _ (&r_l) ; 

r_l  =  xd; 

send_real_32bit _ (&r_l) ; 

r_l  =  yd; 
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send_real_32bit _ (&r_l)  ; 

r_l  =  zd; 

send_real_32bit _ ! 

receive_real_32bit _ (s_cim _ ) ; 

receive__real_32bit _ (&s_cim _ [1] )  ; 

receive_real_32bit _ (&s_cim _ [2] )  ; 

receive_real_32bit _ (&s_cim _ [3] )  ; 

receive_real_32bit _ (&s_cim _ [4] ) ; 

receive_real_32bit _ (&s_cim _ [5] ) ; 

receive_real_32bit _ (&s_cim _ [6] ) ; 

receive~real_32bit _ {&s_cim _ [7] )  ; 

receive_real_32bit _ (&s_cim _ [8] )  ; 

cimtO]  =  s_cim _ [0]; 

cimtl]  =  s_cim _ [1]; 

cimi2i  “  s_cim _ [2]; 

cimi3]  =  s_cim _ [3]; 

cim(4i  =  s_cim _ [4]; 

cimis]  =  s_cim _ [5]; 

cim[6]  =  s_cim _ [6]; 

cim[7]  =  s_cim _ [7]; 

cimiS]  =  s__cim _ [8]; 

/* -  Receive  from  ACSTHR  and  VCSTHR  - C  */ 

receive_real_32bit _ (&s_fxvcs _ ) ; 

rece i ve_rea  1_3 2bi t _ ( &  s_f y ves _ )  ; 

receive_real_32bit _ (&s_f zves _ ) ; 

receive_real_32bit _ _ )  ; 

receive_real_32bit _ (&s_fyacs__2)  ; 

receive~real_32bit _ (&s_fzacs _ )  ; 

fxvcs  =  s_fxvcs _ ; 

fyves  =  s_fyvcs _ ; 

fzves  =  s_fzvcs _ ; 

fxacs  “  s_fxacs _ ; 

fyacs  •'=  s_fyacs _ ; 

fzacs  =  s_fzacs _ ; 

r_l  =  ud; 

send_real_32bit _ (&r_l) ; 

r_l  =  vd; 

send_real_32bit _ (&r_l) ; 

r_l  =  wd; 

send  real  32bit  (&r  1)  ; 


- C  */ 

/*  -  OUTPUT  MODULE 

- C  */ 

/* 


- c  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Creates  print  and  plot  output  data 


files 


-C  */ 

++iprint ; 

if  (iprint  ==  (shortint)  dtprt)  { 
s_wsfi  (&io _ 63)  ; 

do_fio(&c _ 1,  (char  *)&t,  ( ftnlen) sizeof (doublereal) ) ; 
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/* 


do_fio(&c _ 1,  (char 

do_fio(&c _ 1,  (char 

do_fio(&c _ 1,  (char 

do_fio(&c _ 1,  (char 

e_wsfi  n  ; 

outmes_ (message,  128L) 
iprint  =  0; 


*) salt 
*)  &x, 

*)  &y, 
*)&2, 


,  (ftnlen) sizeof (doubiereal) ) 
(ftnlen) sizeof (doubiereal) ) / 
(ftnlen) sizeof (doubiereal) )  ; 
(ftnlen) sizeof (doubiereal) )  ; 


- C  */ 

/* - TERMINATION  LOGIC 

- C  x/ 

/* 


/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

V 

/* 


Defines  the  simulation  termination 

conditions 


- C  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 
iexit  =  0; 

/*  ENABuE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
*/ 

/*  EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED  */ 
if  (t  >=  tfinal)  { 
iexit  =  1; 

) 

/*  ENABLE  EXIT  IF  MISSILE  HAS  IMPACTED  AND  ALL  EVENTS  SCHEDULED  B'OR 
*/ 

/*  THIS  TIME  HAVE  BEEN  EXECUTED  */ 

if  (alt  <  0.)  i 
iexit  =  1; 

) 

/*  increment  time  */ 

tstep  +=  1 . ; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  { 
goto  LIOOO; 

) 

outr.ies_( "ERROR:  Exit  from  P08",  20L)  ; 

}  /*  fiAIN  */ 
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B.3.10  Uup09.c 

/*  uup09.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

finclude  "f2c.h" 

/*  Common  Block  Declarations  */ 

struct  { 

real  gset; 
shortint  iset; 

}  norcom_; 

#define  norcom_l  norcom_ 
struct  { 

real  ranseq[97],  ranlst; 

}  rancom_ • 

#define  rancom_l  rancom_ 

/*  PROGRAM  EXOSIM  */ 

/*  - - - 

-C  V 

/*  -  Declare  and  initialize  variables  - 

-C  */ 

/* - 

-C  */ 

/*  Main  program  */  MAIN _ {) 

{ 

static  shortint  acqd; 
static  real  lamm[2],  delt; 
static  shortint  term; 
static  real  tspudriv,  t; 
static  shortint  track,  iexit; 
static  real  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ ()  ■• 

static  real  lamsek[2]; 

static  integer  skseed; 

extern  /*  Subroutine  */  int  seeker_(); 

static  real  samrat; 

static,  shortint  frment, 

static  real  frmrat,  magrtr; 

extern  /*  Subroutine  */  int  send_real_32bit _ (),  cw37_(); 

static  real  snr; 

/*  $INCLUDE(' :pfp:INCLUDE/target.for')  */ 

/*  INITIALI<iE  80x87  */ 
cw87_()  ; 

/*  SINCLUDEC ssp09.dat')  */ 

/* 

i 


- C  */ 

/*  - execution  loop 

- c  V 

/* 


■c  */ 


Execution  of  all  events  is  performed 
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*/ 

/*  within  this  loop 

C 
*/ 

/* 

C 

*/ 

/* 


- C  */ 

/*  CALL  INITIALIZE_TIMING()  */ 

LIOOO: 

/*  call  reset_timer {)  */ 

/*  timer  =  read_timer()  */ 

/*  CALL  START_TIMING(0)  */ 

/*  WRITE(*,*)' - BEGINNING  OF  LOOP '  */ 

/* 


- C  */ 

/* - 


Processor  communication 


C  */ 


/*  CALL  SWITCH_TIMING{)  */ 

/*  -  COMMUNICATION  WITH  KALMAN 

- C  */ 


send_real_32bit _ (lamm) ; 

send_real_32bit _ (&lamm[l] ) ; 

send_real_32bit _ (&snr) ; 

send_real_32bit _ (Sfrmrat)  ; 

/* - COMMUNICATION  WITH  RELAT 

- C  */ 

receive_real_32bit _ (lamsek) ; 

receive_real_32bit _ (&lamsek  [1] )  ; 

receive_real_32bit _ (Smagrtr)  ; 

/*  CALL  SWITCH_TIMING()  */ 

h 


- C  */ 

/*  -  SEEKER  MODULE 

- C  */ 

/* 


- C  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Calculates  LOS  angles  measured  by  the 
seeker 


- C  */ 

if  (tstep  >=  tspudriv)  { 

/*  TSPUDRIV  =  TSPUDRTV  +  TSPUSTEP  */ 

seeker_(&t,  &acqd,  lamsek,  &magrtr,  Sskseed,  Sfrmrat,  sfrment,  & 
samrat,  strack,  &term,  &snr,  lamm)  ; 
tspudriv  +=  (shortint)  ( (float) le3  /  frmrat) ; 

1 

/*  delt  time  =  (timer  -(read  timer  ()  +  18) ) /1 . 22S<d6  */ 
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/*  CALL  output_message (  %VAL(real_32bit) ,  cielt_time,  */ 

/*  &  %VAL{int2 (1) )  )  */ 

/*  call  output_nl  */ 

/* 


- C  */ 

/*  -  OUTPUT  MODULE 

- C  */ 

/* 


- C  */ 

/*  call  stop_timing()  */ 

/*  if  (  mocl(idnint  (tstep) ,  idnint  (deprt)  )  .eq.O  )  then  */ 
/*  call  output_timing()  */ 

/*  call  INITIALIZE_TIMING()  */ 

/*  ENDIF  */ 

/* 


- C  */ 

/* - TEI^INATION  LOGIC 


/* 


- C  */ 

/*  Defines  the  simulation  termination 

C 
*/ 

/*  conditions 


C 

*/ 

/* 

C 

*/ 

/* 


- C  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  I 
goto  LIOOO; 

} 

)  /*  MAIN  */ 


6 

I 
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B.3.11  UuplO.c 

/*  uuplO.f  —  translated  by  f2c  {version  of  3  February  1990  3:36:42). 

You  must  linlc  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

finclude  "f2c.h" 

/*  Common  Block  Declarations  */ 
struct  { 

doublereal  gset; 
shortint  iset; 

}  norcom_; 

fdefine  norcom_l  norcom_ 
struct  { 

real  ranseq[97],  ranlst; 

)  rancom_; 

fdefine  rancom  1  rancom 


struct  { 

doublereal  drsiga,  psia,  thta,  phia,  thxza,  thxya,  thyza,  thyxa, 
thzya, 

thzxa,  sfla[3],  sf2a(3],  dca(3],  tOacce,  grlst[3],  xyzdp[3], 

abi2  [ 

3],  abil[3],  abo2[3),  abol(3); 

)  raccel_; 

fdefine  raccel_l  raccel_ 

/*  PROGRAM  EXOSIM  */ 

/* - - - 

-C  */ 

/*  -  Declare  and  initialize  variables  - 

-C  */ 

/*  - 

-C  */ 

/*  Main  program  */  MAIN _ () 

{ 

/*  System  generated  locals  */ 
real  r  1; 


/*  Local  variables  */ 

static  real  s_cg _ [3],  s_pd _ ,  s_qd _ ,  s_rd _ ; 

static  doublereal  delt; 

static  real  s_ud _ ,  s_vd _ ,  s_wd _ ,  s_xd _ ,  s_yd _ ,  s_zd _ , 

s_gr _ [3]  ; 

static  doublereal  timudriv,  timustep; 
extern  /*  Subroutine  */  int  accel_(); 
static  doublereal  p,  q,  r,  t; 

static  real  s_cim _ [9]; 

static  shortint  iexit; 
static  doublereal  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  doublereal  cg(3j,  pd,  qd,  rd,  gr[3j,  ud,  vd,  xd,  qfraca[3], 
yd,  zd, 

wd; 

static  integer  gyseed; 
static  doublereal  pulsea[3}; 
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extern  /*  Subroutine  */  int  send_real_32bit _ () ; 

static  doublereal  cim[9]; 

static  real  s_p _ ,  s_q _ ,  s_r _ ; 

extern  /*  Subroutine  */  int  cw87_()  ; 

/*  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
*/ 

/*  DATA  INITIALIZATION  */ 

/*  Sinclude  ( ' ''/include/ssdata35  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdata38  .dat ' )  */ 

/*  Sinclude  { ' ''/include/ssdata39  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdata42  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdata44  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdata45  .dat ' )  */ 

/*  Sinclude  ( '''/include/ssdata46.dat')  */ 

/*  Sinclude  { ' '■/include/ssdata47  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdata48 .  dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdata49.dat ' )  *! 

/*  Sinclude  ( ' ''/include/ssdataSO.dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdataOl  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdatal7  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdatal8  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdata21  .dat ' )  */ 

/*  Sinclude  ( ' ^/include/ssdata22 .dat ' )  */ 

/*  $include  ( ' ''/include/ssdata23  .dat  ’ )  */ 

/*  $include  { ' ''/include/ssdata28  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdata29  .dat ' )  */ 

/*  Sinclude  ( ' ''/include/ssdata30  .dat ' )  */ 

/*  Sinclude  ( ' ^/include/ssdata7l .dat ' )  */ 

/*  $include  ( '''/include/sstiming.dat' )  */ 
cw87_()  ; 

/*  $include  ('sspl0.dat')  */ 

/* 


- C  */ 

/*  - main  execution  loop 

. — . — c  */ 

/* 


- c  */ 

/*  Execution  of  all  events  is  performed 

C 
*/ 

/*  within  this  loop 


C 

*/ 

/* 

C 

*/ 

/* 


- c  V 

LIOOO: 

/*  WRITE(*,*)' - BEGINNING  OF  LOOP - '  */ 

I* 


- C  V 

/x  -  Processor  communication 

- C  */ 

/* 


- C  */ 

/* -  Communicate  with  pOl 
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- C  */ 

receive_real_32bit _ (s_gr _ )  ; 

receive_real_32bit (&s_gr [1] ) ; 

receive_real_32bit (&s_gr [2] )  ; 

gr(0]  =  (doublereal)  s_gr _ (0] ; 

gr[l]  =  (doublereal)  s_gr _ [1]; 

gri2]  =  (doublereal)  s_gr _ [2]; 

r_l  =  pulsea[0]; 

send_real_32bit _ (&r_l)  ; 

r_l  =  pulsea [1] , 

send_real_32bit _ (&r_l) ; 

r_l  =  pulsea [2 ]; 

send_real_32bit _ (&r_l) ; 

receive_real_32bit _ (s_cg _ )  ; 

receive_real_32bit _ (&s_cg _ [1] )  ; 

receive_real_32bit _ (&s_cg _ [2] )  ; 

cg[0]  =  (doublereal)  s_cg _ [0] ; 

cg[l]  =  (doublereal)  s_cg _ [1]; 

cg[2]  =  (doublereal)  s_cg _ [2]; 

receive_real_32bit _ (&s_p _ ) ; 

receive_real_32bit _ (&s_q _ ) ; 

receive_real_32bit _ (&s_r _ ) ; 

p  =  (doublereal)  s  p 
q  =  (doublereal)  s  q  ; 

r  =  (doublereal)  s_r _ ; 

receive_real_32bit _ (£s__xd _ )  ; 

receive_real_32bit^ _ (&s_yd _ )  ; 

receive_real_32bit _ (&s_2d _ ) ; 

xd  =  (doublereal)  s_xd _ ; 

yd  =  (doublereal)  s__yd _ ; 

zd  =  (doublereal)  s~2d _ ; 

receive_real_32bit _ (s_cim _ ) ; 

receive_real_32bit _ (&s_cim _ [1] ) ; 

receive_real~32bit _ (ss_cim _ [2] ) ; 

receive_real~32bit _ (&s_cim _ [3] ) ; 

receive_real~32bit _ (&s_cim _ [4] )  ; 

receive_real_32bit _ (&s_cim _ [5] ) ; 

receive_real_32bit _ {&s_cim _ [6] )  ; 

receive_real_32bit _ (&s_cim _ [7] ) ; 

receive_real_32bit _ (&s_cim _ [8] ) ; 

cim[01  =  (doublereal)  s_cim _ [0]; 

cimil]  =  (doublereal)  s_cim _ [1]; 

cimi2]  =  doublereal)  s_cim _ [2]; 

cimP]  =  (doublereal)  s_cim _ [3]; 

cim[4i  =  (doublereal)  s_cim _ [4]; 

cim[5]  =  (doublereal)  s_cim _ [5]; 

cim[6]  =  (doublereal)  s_cim _ [6]; 

cim[7]  =  (doublereal)  s_cim _ [7]; 

cim[8)  =  (doublereal)  s_cim _ [8]; 

receive_real_32bit _ (&s_pd _ ) ; 

receive_real_32bit _ (&s__qd _ )  ; 

receive_real_32bit _ (&sjrd _ ) ; 

receive_real_32bit _ (&s_ud _ ) ; 

receive_real_32bit _ (&s_vd _ ) ; 

receive_real_32bit _ (&s_wd _ ) ; 

pd  =  (doublereal)  s_pd _ ; 

qd  =  (doublereal)  s_qd _ ; 

rd  =  (doublereal)  s_rd _ ; 

ud  ==  (doublereal)  s_ud _ ; 

vd  =  (doublereal)  s_vd _ ; 

wd  =  (doublereal)  s  wd  ; 


C  */ 
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/* - 

- C  */ 

/* 


- C  */ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 


- c  */ 

if  (tstep  >=  timudriv) 
timudriv  +=  timustep; 

/* 


/* 

/* 


C  */ 

- C  */ 


■  INERTIAL  MEASUREMENT  UPDATE 

Get  inertial  measurement  data  needed 
for  guidance  calculations  . 


ACCELEROMETER  MODULE 


- C  */ 

/*  Determine  sensed  accelerations 

C  */ 

/* 

C  */ 

/* 


- c  */ 

accel_{&t,  &ud,  &vd,  &wd,  Sp,  &q,  &r,  &pd,  &qd,  Srd,  eg,  cim,  &xd, 

& 

yd,  &zd,  gr,  figyseed,  qfraca,  pulsea) ; 

} 

/* 


- C  */ 

/* - TERMINATION  LOGIC 

- C  */ 

/* 

- C  */ 

/* 

C 
*/ 

/* 
c 
*/ 

/* 
c 
*/ 

/* 

- c  */ 

/*  INITIALIZE  S'^MULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  increment  time  */ 
tstep  +=  1 . ; 
t  =  tstep  *  delt; 


Defines  the  simulation  termination 

conditions 
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/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  { 
goto  LIOOO; 

) 

}  /*  MAIN  */ 
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B.3.12  Uupll.c 

/*  uupll.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42)  . 

You  must  lin)c  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Common  Bloc)c  Declarations  */ 
struct  { 

shortint  iseq[4]; 
real  tveomp,  omega0[3]; 
shortint  imidb2; 
real  tmidb2; 
shortint  is)c3on; 

)  rmguid_; 

#define  rmguid_l  rmguid_ 
struct  { 

real  angacl[120]  /*  was  [3]  [4]  [10]  */; 

shortint  imcpas[12]  /*  was  [3]  [4]  */; 

real  tp2end,  tp3end; 

shortint  ip2end; 

real  tcoast; 

shortint  icoast; 

real  trdone; 

shortint  irate,  iacsbl,  iacsb2,  ient,  ivpfl,  ivpfln; 
real  tburn2,  omegai[3],  tlstma,  aaccelll2]  /*  was  [3]  [4]  */; 
)  rmauto_; 

#define  rmauto_l  rmauto_ 
struct  { 

real  swl7,  swl8,  swl8p,  swl8y,  swl9,  swl9p,  swl9y; 
shortint  iroll; 

real  tpton2,  tyton2,  tnextp,  tnexty,  fltcpl,  fltcyl; 

)  r3cvaut_; 

#define  r)cvaut_l  r)cvaut_ 

/*  Table  of  constant  values  */ 

static  shortint  cs _ 0  =  0; 

static  shortint  cs _ 1  =  1; 

/*  PROGRAM  EXOSIM  */ 

/* - 

-C  */ 

/*  -  Declare  and  initialize  variables  - 

-C  */ 

/* - 

-C  */ 

/*  Main  program  */  MAIN _ () 

{ 

/*  System  generated  locals  */ 
real  r_l; 

/*  Local  variables  */ 

static  shortint  acqd,  icmd; 

static  real  lamd[2],  magr,  delt,  fltc[4]; 
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static  shortint  flip; 
static  real  magv; 
static  shortint  igit; 

static  real  tsah,  dtacsa_s _ [4],  dtacsb_s _ (4],  mass,  rrel(3], 

vrel [3] , 

tsal,  anvp,  acslev_s _ ; 

static  shortint  ives; 

static  real  tgil,  dtoffv_s _ [4],  tofflt_s _ [4]; 

static  shortint  ithres_s _ ; 

extern  /*  Subroutine  */  int  send_signed_16bit _ (); 

static  real  tburnm_s _ ,  tapudriv,  timonv_s _ ,  tgpudriv,  tapustep, 

tgilp, 

tgi2p,  tgi3p,  tgpustep,  tgily,  tgi2y,  tgi3y,  tstg2,  t,  tatab; 
static  shortint  ivtab; 
static  real  fltcp; 
static  shortint  idist,  idrop; 
static  real  dteps,  tvtab,  piter,  tlaps,  fltcy; 
static  shortint  iexit; 

static  real  yawer,  tdrop,  urrelt3],  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ () ; 

static  real  tkvon,  tnext,  tge2al; 

static  shortint  iburnl,  iburn2,  iburn3; 

static  real  vg[3],  dtacsa[4],  dtacsb[4],  sp,  sq,  sr; 

static  shortint  idmeas,  imeend; 

extern  /*  Subroutine  */  int  mcguid_{); 

static  shortint  midbrn,  iacson; 

static  real  acslev,  tfinal; 

static  shortint  estate,  iburnd,  ivcs_s _ ; 

static  real  adistt[12]  /*  was  [4]  [3]  */,  dtoffv[4],  mgrdot, 
dtvesp 13] 

,  tofflt[4]; 

extern  /*  Subroutine  */  int  mcauto_(); 

static  real  roller,  dtvesytS]; 

static  shortint  iburnm,  ipassm; 

static  real  traton,  tpaton,  tyaton,  dtsamp; 

static  shortint  ithres; 

static  real  tmauto,  tournm,  timonv; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  real  trmtgo; 

extern  /*  Subroutine  */  int  estrel_(); 

static  real  tmguid; 

static  shortint  idpass; 

extern  /*  Subroutine  */  int  kvauto_(); 

static  real  tewait; 

extern  /*  Subroutine  */  int  vcslog_(); 
static  real  tofltm,  tburnp,  tburny; 
extern  /*  Subroutine  */  int  acsthr2_(); 
static  real  tgoflm; 

extern  /*  Subroutine  */  int  resthr_(),  vcsthr2_{); 

static  real  cms[9]; 

extern  /*  Subroutine  */  int  cw87_(); 

static  real  vgm[3],  tgo,  tatab_s _ ,  sw80; 

static  shortint  ivtab_s _ ; 

static  real  ixx,  iyy,  izz; 

static  shortint  idrop_s _ ; 

static  real  tvtab_s _ ,  tgel,  tge2,  ti2m[9]; 

extern  /*  Subroutine  */  int  receive_signed_16bit _ (); 

/*  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGKT  CAPABILITIES  ONLY 
*/ 

/*  OUTPUTS  */ 

/*  NAMELIST  INPUTS  */ 

/*  DATA  INITIALIZATION  */ 
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/*  $INCLUDE(  '''/INCLUDE/SSDATA35.DAT') 
/*  $INCLUDE(  '''/INCLUDE/SSDATA38.DAT') 
/*  $INCLUDE( '"/INCLUDE/SSDATA39.DAT') 
/*  $INCLUDE ( ' ^/INCLUDE/SSDATA42 .DAT' ) 
/*  $INCLUDE  (  '  ''/INCLUDE/SSDATA44  .DAT' ) 
/*  $INCLUDE(  '''/INCLUDE/SSDATA45.DAT') 
/*  $INCLUDE  ( '''/INCLUDE/SSDATA46.DAT') 
/*  $INCLUDE  (  '  ''/INCLUDE/SSDATA47  .DAT' ) 
/*  $INCLUDE(  '''/INCLUDE/SSDATA48.DAT') 
/*  $INCLUDE(  •''/INCLUDE / SSDATA49.DAT') 
/*  $INCLUDE ( '"/INCLUDE/SSDATA50 .DAT') 
/*  $INCLUDE(  '''/INCLUDE/SSDATAOl.DAT') 
/*  $ INCLUDE ( ' "/INCLUDE/SSDATA17 .DAT' ) 
/*  $INCLUDE(  •''/INCLUDE / SSDATA18.DAT') 
/*  $INCLUDE{  '''/INCLUDE/SSDATA21.DAT') 
/*  $INCLUDE(  '''/iNCLUDE/SSDATA22.DAT') 
/*  $ INCLUDE ( ' ^/INCLUDE/SSDATA23 .DAT' ) 
/*  $INCLUDE(  '''/INCLUDE/SSDATA28.DAT') 
/*  $INCLUDE<  '''/INCLUDE/SSDATA29.DAT') 
/*  $  INCLUDE  (  '''/INCLUDE/SSDATA30.  DAT') 
/*  $INCLUDE(  '''/INCLUDE/SSDATA71.DAT') 
/*  $INCLUDE  ( '  ''/INCLUDE/SSTIMING  .  DAT ' ) 
/*  $INCLUDE(' :pfp:INCLUDE/target.for') 
/*  INITIALIZE  80x87  */ 

Cw87_()  ; 

/*  $ INCLUDE ('SSpll.DAT')  */ 

mcauto_(&t,  &.ixx,  £iyy,  &izz,  &sp, 
Syawer,  & 

idist,  &iacson,  siburnd,  &ifc 
traton,  &tpaton,  &tyaton,  &c 

Sithres, 

sanvp,  &acslev,  stmauto,  &c£ 


$ INCLUDE ( ' 
$ INCLUDE ( 
$ INCLUDE ( ’ 
$INCLUDE( ' 
$ INCLUDE { 
$INCLUDE( ’ 
$INCLUDE(’ 
$ INCLUDE ( 
$INCLUDE  < 

$ INCLUDE ( 
$ INCLUDE ( 


,  &izz,  &sp,  &sq,  &sr,  Sroller,  spiter, 

Siburnd,  siburnm,  sidmeas,  fiipassm,  &icmd, 
&tyaton,  &dtsamp,  &tsal,  &tsah,  &tlaps. 


idrop_s _ 

=  idrop; 

acslev_s _ 

=s 

acslev; 

dtacsa_s _ 

(0] 

dtaesa [0]; 

dtacsa_s _ 

[1] 

- 

dtaesa [1] ; 

dtacsa_s _ 

[2] 

- 

dtaesa [2] ; 

dtacsa_s _ 

C3] 

= 

dtaesa [3] ; 

dtacsb_s _ 

(0] 

dtaesb [0] ; 

dtacsb_s _ 

[1] 

= 

dtacsb[li ; 

dcacsb_s_ _ 

[2] 

= 

dtaesb [2] ; 

dtacsb_s”_ 

[3] 

= 

dtaesb i3] ; 

dtoffv_s _ ^ 

[0] 

= 

dtof fv(0] ; 

dtof fv~s _ 

[1] 

dtoffv(l] ; 

dtof fv_s _ 

[2] 

= 

dtoffv(2 J ; 

dtof fv_s _ 

[3] 

= 

dtoffv(3} ; 

ithres_s _ 

ss 

ithres; 

ivcs_s _  = 

■'  ves 

ivtab_s _ 

=  ivtab; 

tatab_s _ 

=  tatab; 

tburnm_s _ 

= 

tburnm; 

timonv_s _ 

= 

timonv; 

tofflt  s 

[0] 

= 

tofflt [0] ; 

to£flt_s _ 

[1] 

= 

tofflt [1] 

tofflt_s _ 

[2] 

= 

tofflt [2] ; 

tof f lt~s _ 

[3] 

= 

tofflt [31 ; 

tvtab  s  ~ 

=  tvtab; 

Stmauto, 
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- C  */ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 

c 

*/ 

/* 


Execution  of  all  events  is  performed 
within  this  loop 


- C  */ 

LlOuO: 

/*  WRITE{*,*)' - BEGINNING  OF  LOOP - '  */ 

/* 


- C  */ 

/*  -  Processor  communication 

- C  */ 

/* 


- C  */ 

/* - COMMUNICATION  WITH  POO 

- C  */ 

receive_real_32bit _ (&ixx)  ; 

receive  real  32bit  ~(&ivv)  ; 

receive_real_32bit _ (&izz) ; 

receive  real  32bit  (&mass) ; 


/* - COMMUNICATION  WITH  POO 

- C  */ 

send_signed_l  6bit _ ( &  idrop_s _ )  ; 

/* - COMMUNICATION  WITH  P02 

- C  */ 

send_real_32bit _ (&acslev_s _ )  ; 

send_real_32bit _ (dtacsa_s _ )  ; 


send_real_32bit _ (&dtacsa_s _ [1] )  ; 

send_real_32bit _ {&dtacsa_s _ [2] )  ; 

send_real_32bit _ (&dtacsa_s _ [3} )  ; 

send_real_32bit _ {dtacsb_s _ ) ; 

send_real_32bit _ {&dtacsb_s _ [1] ) ; 

send_real_32bit _ (&dtacsb_s _ [2] )  ; 

send_real_32bit _ (&dtacsb_s _ [3] )  ; 

send_real_32bit _ (dtoffv_s _ )  ; 

send_real_32bit _ (&dtoffv_s _ [1] ) ; 

send_real_32bit _ (&dtoffv_s _ [2] )  ; 

send_real_32bit _ Udtoffv_s _ [3] )  ; 

send_signed_i6bit _ (&ithres_s _ )  ; 

send_signed_16bit _ (&ivcs_s _ )  ; 

send_signed_l 6bit _ (&ivtab_s _ ) / 

send_real_32bit _ (&tatab_s _ ) ; 

send_real_32bit _ {&tburnm_s _ ) ; 

send_reai_32bit _ (&timonv__s _ )  ; 

send_real_32bit _ (toff It  s  )  ; 

send_real_32bit _ (&toff lt_s _ (Ij ) ; 

send_real_32bit _ (&tofflt_s _ [2] ) ; 

send_real_32bit _ (Stofflt _s _ [3] ) ; 

send_real_32bit _ (stvtab  s  )  ; 

/* - COMMUNICATION  WITH  P02 

- C  */ 

receive_signed_l 6bit _ ( & iacson)  ; 

/* - COMMUNICATE  WITH  CORVEL - C  */ 

receive_real_32bit _ (vg) ; 

receive_real_32bit _ (&vg[l]) ; 
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receive_real_32bit _ (&vg  [2] )  ; 

/* - DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG 

- C  */ 

receive_real_32bit _ (ti2m) ; 

receive_reai_32bit _ (&ti2m[l] ) ; 

receive_real_32bit _ (&ti2m[2] ) ; 

receive_real_32bit _ (&ti2m[3] ) ; 

receive_real_32bit _ Uti2m[4] ) ; 

receive_real_32bit _ Uti2mi5] ) ; 

receive_real_32bit _ (&ti2m[6} ) ; 

receive_real_32bit _ (&ti2mi7] ) ; 

receive_real_32bit _ (&ti2m[8i ) ; 

receive_real_32bit _ (vrel) ; 

receive_real_32bit _ (Svrel [ 1] )  ; 

receive_real_32bit _ (&vrel [2 ] ) ; 

receive_real_32bit _ (rrel) ; 

receive_real_32bit _ (&rrel[l] )  ; 

receive_real_32bit _ (Srrel [2] ) ; 

receive_real_32bit _ (&sp) ; 

receive_real_32biL _ (Ssq) ; 

receive_real_32bit _ (ssr),  ; 

send._real_32bit _ (fimagr)  ; 

send._real_32bit _ {&magv)  ; 

send_real_32bit _ (&tgo) ; 

send_real_32bit _ (fipiter)  ; 

send_real_32bit _ (sroller)  ; 

send_real_32bit _ (&yawer) ; 

send_signed_16bit _ (&iburnl) ; 

send_real_32bit _ (lamd) ; 

send~real_32bit _ {&lamd[l]) ; 

send~signed_16bit _ (iacqd) ; 

receive_signed_l 6bit _ ( &estate ) ; 

receive_real_32bit _ (ipiter) ; 

receive_real_32bit _ (Sroller) ; 

receive_real_32bit _ (Syawer) ; 

receive_signed_16bit _ (siburnl) ; 

receive_real_32bit _ (lamd) ; 

receive_real_32bit _ Ulamd[l] ) ; 

receive_signed_16bit _ (&acqd) ; 

receive_real_32bit _ (&tgel) ; 

receive_real_32bit _ (&tge2al)  ; 

receive_real_32bit _ (itrmtgo) ; 


- C  */ 

/*  ON  BOARD  GUIDANCE  PROCESSING 

C 
*/ 

/* 


- c  */ 

/*  Determine  guidance  commands 

C 
*/ 

/* 

C 

*/ 

/* 

- C  */ 

if  (tstep  >=  t-gpudriv)  ( 

/*  TGPUDRIV  =  TGPUDRIV  +  TGPUSTEP  */ 
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- C  */ 

/*  -  ESTIMATED  RELATIVE  STATES  MODULE 

- C  */ 

/* 


- C  */ 

/*  Estimate  range,  range  rate,  and 

time-to-  C  */ 

/*  go  based  on  navigation  output  and 

target  C  */ 

/*  model  estimates 

C  */ 

/* 

C  V 

/* 


- c  */ 

estrel_(ti2m,  ems,  fiestate,  rrel,  vrel,  Sraagr,  &magv,  urrel, 
Smgrdot, 

&tgo,  &piter,  syawer,  lamd) ; 

) 

/* 


- C  */ 

/*  -  Processor  communication 


- C  */ 

/* - COMMUNICATION  WITH  POO 

- - C  */ 

receive_real_32bit _ (sixx)  ; 

receive_real_32bit _ Uiyy) ; 

receive_real_32bit _ Uizz) ; 

receive  real  32bit  Umass) ; 


/* - COMMUNICATION  WITH  POO 

- C  */ 

send_signed_16bit _ {&idrop_s_  )  ; 

/*  - COMMUNICATION  WITH  P02 


- C  */ 

send_real_32bit _ (&acslev_s _ ) ; 

send_real_32bit _ (dtacsa_s _ ) ; 

send_real__32bit _ (&dtacsa_s _ [1] )  ; 

send_real~32bit _ (&dtacsa_s _ [2] ) ; 

^end__real__32bit _ {&dtacsa_s _ [3] )  ; 

send_real_32bit _ (dtacsb_s _ ) ; 

send_real_32bit _ (&dtacsb_s _ fl] )  ; 

send_real  _32bit _ <&dtacsb_s _ [2] )  ; 

send_real”32bit _ (&dtacsb_s _ [3] )  ; 

send_real_32bit _ (dtoffv_s _ )  ; 

send_real_32bit _ (&dtoffv_s _ [1] ) ; 

send_real_32bit _ (&dtoffv_s _ [2] )  ; 

send_real_32bit _ (&dtoffv_s _ (3] ) ; 

send_signed_l 6bit _ ( & ithres_s _ ) ; 

send_signed_16bit _ (&ivcs_s _ ) ; 

send_signed_16bit _ {Sivtab_s _ ) ; 

send_real_32bit _ (&tatab_s _ ) ; 

send_real_32bit _ [(&tburnm_s _ ) ; 

send  real  32bit  (&timonv  s_  ')  ; 

send_real_32bit _ (tofflt_s _ )  ; 

send  real_32bit _ (&tofflt_s _ [1] ) ; 

send_real_32bit _ (&tofflt_s _ [2] ) ; 

send_real_32bit _ (&cofflt_s _ [3] )  ; 

send  real  32bit  (Stvtab  s  ) ; 
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/* - COMMUNICATION  WITH  P02 

- C  */ 

receive_sign€  ^_16bit _ (Siacscn) ; 

/* - COMMUNICATE  WITH  CORVEL - C  */ 

receive_real_32bit _ (vg) ; 

receive_real_32bit _ (&vg[l] ) ; 

receive_real_32bit _ (&vgi2] ) ; 

/*  - daisy  chain  with  IMUPRO  AND  NAVIG 

- C  */ 

receive_real_32bit _ (ti2m) ; 

receive_real_32bit _ {&ti2m[l] ) ; 

receive_real_32bit _ (&ti2ni[2i )  ; 

receive_rea.l_32bit _ {&ti2m[3] ) ; 

receive_real_32bit _ {&ti2ini4] )  ; 

receive_real_32bit _ (&ti2mi5] ) ; 

receive_real_32bit _ (&ti2m[6] ) ; 

receive_real_32bit _ (&ti2m[7] )  ; 

receive_real_32bit _ {&ti2m[8] ) ; 

receive_real_32bit _ (vrel)  ; 

receive_real_32bit _ {&vrel(l] ) ; 

receive_real_32bit _ (&vrel[2]) ; 

receive_real_32bit _ (rrel) ; 

receive_real_32bit _ (firreltl] ) ; 

receive_real_32bit _ (&rreli2i ) ; 

receive_real_32bit _ (&sp) ; 

receive_real_32bit _ (&sq) ; 

receive  real  32bit  {&sr) ; 

/* 

- C  */ 

/*  -  MISSILE  state  update  MODULE 

- C  */ 

/* 


- C  */ 

/*  Integrate  missile  states  to  current  time 

C 
*/ 

/* 

C 

*/ 

/* 


- c  */ 

/* 


- c  */ 

/*  -  vcs  thruster  response  module 

- c  */ 

/* 


- c  */ 

/*  Determines  the  forces  and  moments 

C 
*/ 

/*  imparted  by  the  VCS  thrusters 


C 

*/ 

/* 

C 

V 

/* 


c  */ 
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vcsthr2_(&t,  fltc,  Sfltcp 
Sivtab) ; 

/* 
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&fltcy,  Stburnm,  tofflt,  &timonv, 

/*  - 

/* 

- c  */ 

- c  */ 

-  ACS  THRUSTER  RESPONSE  MODULE 

/* 

C 

/* 

C 

/* 

C 

/* 

- c  */ 

★  / 

/ 

V 

*/ 

Determines  the  forces  and  moments  , 

imparted  by  the  ACS  thrusters  1 

1 

1 

/* 

- c  */ 

acsthr2  (Sithres) ; 

} 

— 

-C  */ 

1 

/*  - 

- - 

-  SEPARATION  MODULE 

/* 

- c  */ 

-c  */ 

1 

/* 

c 

*/ 

Models  discontinuities  occuring  during 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

stage  separation  ' 

...... 

— c  */ 

/* 

NOSE  FAIRING  /  BOOST 

ADAPTER  SEPARATION  */ 

if  (idrop  ==  1  II  (r  1  =  t 

-  tdrop,  dabs(r  1))  <=  dteps  &&  igit  == 

1) 

/* 

{ 

idrop  =  2; 
ipassm  =  0; 

} 

if  (tstep  >=  tgpudriv)  { 
tgpudriv  +=  tgpustep; 

— 

- C  */ 

/*  ■ 

-  MIDCOURSE  GUIDANCE  MODULE 

/* 

- c  */ 

— 

- C  */ 

/* 

Z'GI.X  COntlZOj.3 

c 

*/ 

/* 

midcourse  sequencing,  and  issues 

c 

*/ 

/* 

midcourse  diverts 

c 

*/ 
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/* 


- C  */ 

if  (t  >  tstg2  &&  t  >=  tmguid  &&  acqd  ==  0)  { 

mcguid_(&t,  ti2m,  vg,  urrel,  &mass,  &idist,  smidbrn,  &magr, 

firaagv, 

&sp,  &sq,  &sr,  spiter,  fiyawer,  &flip,  &ivcs,  &icmd,  & 
idmeas,  sidpass,  &idrop,  Simeend,  siburnd,  siburnm,  vgm, 
adistt,  firoller,  &tmguid) ; 

} 

} 

/* 


_ r  *  j 

/*  - KALMAN  FILTER  MODULE 

- C  */ 

/* 


-C  */ 

send_real_32bit _ (&magr) ; 

send_real_32bit _ (fimagv) ; 

send_real__32bit _ {&tgo)  ; 

send_real~32bit _ (spiter)  ; 

send_real_32bit _ (Sroller)  ; 

send_rGal_32bit _ (iyawer) ; 

send_signed_16bit _ (Siburni) , 

send_real_32bit _ (lamd)  ; 

send_real_32bit _ ( &  lamd  [ID; 

send_signed_16bit _ (Sacqd) ; 

receive_signed_l 6bit _ ( fiestate) ; 

receive”real_32bit _ (spiter) ; 

receive_real_32bit _ (& roller) ; 

receive~real_32bit _ (&yawer) ; 

receive_signed_l 6bit _ ( & iburnl ) ; 

receive”real_3?bit _ (lamd) ; 

receive”real_32bit _ (&lamd[lD ; 

receive~signed_16bit _ (&acqd) ; 

receive__rea]_32bit _ (stgel) ; 

receive”real_32bit _ (&tge2al) ; 

receive_real_32bit _ (Strmtgo) ; 


- C  */ 

/* - 


Processor  communication 


- C  */ 

/* - COMMUNICATION  WITH  POO 

- • - c  */ 

receive_real_32bit _ (sixx) ; 

receive_real_32bit _ (&iyy) ; 

receive_real_32bit _ (&izz)  ; 

receive  real  32bit  (&mass); 


/* - COMMUNICATION  WITH  POO 

- C  */ 

send_signed_16bit _ (&idrop_s _ )  ; 

/* - COMI-IUNICATION  WITH  P02 


- C  */ 

send_real__32bit _ (&acslev_s _ )  ; 

3end_real_32bit _ (dtacsa_s _ ) ; 

send_real_32bit _ (&dtacsa_s _ [1] ) ; 

send_real_32bit _ (&dtacsa_s _ [2] )'  ; 

send  real  32bit~  (sdtaesa  s  (3)); 
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send_real_32bit {dtacsb_s ) ; 

send_real_32bit _ (&dtacsb_s _ [1] ) ; 

send_real_32bit _ (&dtacsb_s _ [2] ) ; 

send_real_32bit _ (&dtacsb_s _ [3] ) ; 

send_real_32bit (dtoffv_s ) ; 

send_real__32bit _ (sdtof  fv_s _ [1] )  ; 

send_real”32bit _ (&dtof fv_s _ (2] ) ; 

send_real_32bit _ (&dtoffv_s _ [3] )  ; 

sond_signed_l  6bit _ ( & ithres_s _ )  ; 

send_signed_16bit _ (&ivcs_s _ ) ; 

send_sign9d_16bit _ (&ivtab_s _ ) ; 

send_real_32bit _ (&tatab_s _ ) ; 

send_real_32bit _ (&tburnm_s _ ) ; 

send_real_32bit _ (&timonv_s _ ) ; 

send_real_32bit _ (tofflt_s _ ) ; 

send_real_32bit _ (&tofflt_s _ [1] ) ; 

send_real_32bit' _ {&tofflt_s _ [2] )  ; 

send_real_32bit _ (&tofflt_s _ [3] ) ; 

send_real_32bit _ (&tvtab_s _ )  ; 

/* - COMMUNICATION  WITH  P02 

- - - C  */ 

receive_signed_l 6bi t _ ( & iacson )  ; 

/* - COMMUNICATE  WITH  CORVEL - C  */ 

receive_real_32bit _ (vg) ; 

receive_real_32bit _ (&vg[l]) ; 

receive_real_32bit _ (&vgi2]) ; 

/* - DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG 

- C  */ 

receive_real_32bit _ (ti2m)  ; 

receive_real_32bit _ (&ti2m[l] ) ; 

receive_real_32bit _ {&ti2m[2i ) ; 

receive_real_32bit _ (&ti2mi3] ) ; 

receive_real_32bit _ (&ti2m[4] ) ; 

receive_real_32bit _ {&ti2m[5] ) ; 

receive_real_32bit _ (&ti2mi6i) ; 

receive_real_32bit _ Uti2m[7i ) ; 

receive_real_32bit _ Uti2m(8i ) ; 

receive_real_32bit _ (vrel)  ; 

receive_real_32bit _ (&vrel[:i  ] )  ; 

receive_real_32bit _ (&vrel  [2] )  ; 

receive_real__32bit _ (rrel)  ; 

receive_reai  ■^2bit _ (&rrel[l]); 

receive_real_j2bit _ (&rrel(2])  ; 

receive_real_32bit _ (&sp) ; 

receive_real_32bit _ (&sq) ; 

receive_real_32bit _ (&sr)  ; 

send_real_32bit _ (&magr) ; 

send_real_32bit _ (&magv) ; 

send_real_32bit _ (&tgo) ; 

send_real_32bit _ (Spiter) ; 

send_real_32bit _ (Sroller) ; 

send_real_32bit _ (syawer) ; 

send_signed_16bit _ (siburnl) ; 

3end_real_32bit _ (lamd) ; 

send_real_32bit _ (&lamd [ 1 ] ) ; 

send_signed_16bit _ (Sacqd) ; 

receive_signed_l 6bit _ { &estate ) ; 

receive_real_32bit _ (&piter) ; 

receive_real_32bit _ (droller) 

receive_real_32bit _ (&yawer)  ; 

receive_signed_16bit _ (&iburnl ) ; 

receive_real_32bit _ (lamd) ; 

receive_real_32bit _ (&lamd[l] ) 

reGeive_signed_16bit _ (Sacqd) ; 
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receive_real_32bit _ (atgel) ; 

receive_real_32bit _ (&tge2al)  ; 

receive_real_32bit _ (&trmtgo) ; 


- C  */ 

/* - AUTOPILOTS 

- C  *! 

/* 


- C  */ 

/* 

c 

*/ 

/* 


-c  */ 

if  (tstep  >=  tapudriv)  ( 


- C  */ 

/*  -  MIDCOUkSE  AUTOPILOT  MODULE 

- C  */ 

/* 


- C  */ 

/*  Performs  large  angle  reorients  and 

rate  C  */ 

/*  control  during  midcourso 

C  */ 

/* 


- C  */ 

if  (t  >=  tkvon)  { 

if  <t  >  tstg2  &&  t  >=  tmauto  &&  (icmd  !•-  0  II  acqd  ==  0) )  { 
mcauto_<fit,  Sixx,  &iyy,  &izz,  &sp,  &sq,  &sr,  sroller, 

&piter, 

Syawer,  sidist,  Siacson,  &iburnd,  siburnm,  Sidmeas,  & 
ipassm,  &icmd,  Straton,  stpaton,  &tyaton,  &dtsamp,  & 
tsal,  stsah,  stlaps,  sithres,  &anvp,  sacslev,  &tmauto, 
&CS _ 1)  ; 

1 

} 

) 

/* 


- C  */ 

/* - 


Pro::essor  communication 


- C  */ 

idrop_s _  =  idrop; 

/*  - COMMUNICATION  WITH  POO 

- C  */ 


receive_real_32bit _ (&ixx) ; 

receive_real_32bit _ {&iyy) ; 

receive_real_32bit _ (&izz) ; 

receive_real_32bit  (Smass); 


/*  - COMMUNICATION  WITH  POO 

- C  */ 

send_signed_l 6bit _ (&idrop_s _ ) ; 

/* - COMMUNICATION  WITH  P02 

- Q  */ 
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send_real_32bit _ (&acslev_s _ )  ; 

send_real_32bit _ (dtac?a_s _ ) ; 

send_real__32bit _ (&dtacsa_s _ [1] )  ; 

send_real_32bit _ {&dtacsa_s _ [2] )  ; 

send_real_32bit _ (&dtacsa_s _ [3] )  ; 

send_real_32bit _ (dtacsb_s _ ) ; 

send_real_32bit _ (&dtacsb_s _ (1] )  ; 

send_real_32bit _ (&dtacsb_s _ [2] )  ; 

send_real_32bit _ (&dtacsb_s _ [3] ) ; 

send_real_32bit _ {dtoffv_s _ ) ; 

send_real_32bit _ (&dtof fv_s _ [1] ) ; 

send_real_32bit _ Udtoffv_s _ [2] )  ; 

send_real_32bit _ <&dtoffv_s _ [3] )  ; 

send_signed_16bit _ (&ithres_s _ )  ; 

send_signed_16bit _ (&ivcs_s _ )  ; 

send_signed_16bit _ (&ivtab_s _ )  ; 

send_real_32bit _ (&tatab_s _ ) ; 

send_real_32bit _ (&tburnm_s _ ) ; 

serrd_real_32bit _ (&timonv_s _ )  ; 

send_real_32bit _ (tofflt_s _ )  ; 

send_real_32bit _ _ [1] )  ; 

send_real_32bit _ (&tofflt_s _ [2] )  ; 

send_real_32bit _ (&tofflt_s _ [3] ) ; 

send_real_32bit _ (&t:vtab_s _ )  ; 

/* - COMMUNICATION  WITH  P02 

- C  */ 

receive_signed_16bit _ (Siacson) ; 

/* - COMMUNICATE  WITH  CORVEL - C  */ 

receive_real_32bit _ (vg)  ; 

receive_real_32bit _ (&vg[l] )  ; 

receive_real_32bit _ (&vgi2] ) ; 

/* - DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG 

- C  */ 

receive_real_32bit _ (ti2m) ; 

receive_real_32bit _ (&ti2mil) ) ; 

receive_real_32bit _ {&ti2m(2i ) ; 

receive_real_32bit _ {&ti2m(3} ) ; 

receive_real_32bit _ (&ti2nii4i )  ; 

receive_real_32bit _ (&ti2m[5i ) ; 

receive_real_32bit _ (&ti2m(6] ) ; 

receive_real_32bit _ (&ti2m(7] ) ; 

receive_real_32bit _ {&ti2m(8i ) ; 

receive_real_32bit _ (vrel) ; 

receive_real_32bit _ (Svrel [1] )  ; 

receive_real_32bit _ {&vreli2] )  ; 

receive_real_32bit _ (rrel) ; 

receive_real_32bit _ (&rrel [1] ) ; 

receive_real_32bit _ (&rrel (2] ) ; 

receive_real_32bit _ (&sp) ; 

receive_real_32bit _ (&sq) ; 

receive_real_32bit _ (&sr) ; 

send_real_32bit _ (&niagr)  ; 

send  real  32bit  ~(&maqv) ; 

send_real_32bit _ (&tgo) ; 

send_real_32bit _ (spiter) ; 

send_real_32bit _ (Sroller) ; 

send_real_32bit _ <&yawer) ; 

send_signed_16bit _ (siburnl)  ; 

send_real_3?bi t _ (lamd) ; 

send_real_32bit _ (&lamd [1] ) ; 

send_signed_16bit _ (&acqd) ; 

receive_signed_16bit _ (sestate) ; 

receive_real_32bit _ (&picer) ; 

receive  real  32bit  (Sroller); 
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receive_real_32bit _ (Syawer) ; 

receive_signed__16bit _ (&iburnl )  ; 

receive_real_32bit _ (lamd) ; 

receive_real_32bit _ (&lamd[l] ) ; 

receive_signed_16bit _ (&acqd) ; 

receive_real_32bit _ (Stgel)  ; 

receive_real_32bit _ (&tge2al) ; 

receive_real_32bit _ (strmtgo) ; 


- C  */ 

/* - 


/* 


- C  */ 

/* 

c 

*/ 

/* 


c  */ 


AUTOPILOTS 


-C  */ 

if  (tstep  >=  tapudriv) 
if  (t  >=  tkvon)  { 


/* 


/* 


C  */ 

- c  */ 


/* 

/* 


c 


c 

/* 

flight . 
/* 


C 

/* 

and  at 
/* 

C 

/* 

C 


/* 


*/ 

*/ 

*/ 

c 

*/ 

*/ 


c  */ 


c  */ 


*/ 


KV  AUTOPILOT  MODULE 


Calls  the  various  ACS  autopilot 
modes  used  for  controlling  the 
kill  vehicle  attitude  during 
Its  purpose  is  to  define  which 
thruster  to  burn,  for  how  long, 
what  thrust  level. 


Sc 


- C  */ 

kvauto_{&t,  &sp,  &sq,  &sr,  sfltcp,  Sfltcy,  &ixx,  &iyy,  &izz, 

adistt,  Sroller,  apiter,  Syawer,  stewait,  Sidist,  &sw80, 

tsal,  &tsah,  stnext,  stlaps,  &anvp,  sdtsamp,  &acslev,  & 
traton,  stpaton,  styaton,  sithres) ; 


) 

/* - COMMUNICATION  WITH  POO 

- C  */ 

teceive_real_32bit _ (S<ixx)  ; 

receive_real_32bit _ (&iyy)  ; 

receive_real_32bit _ (&izz)  ; 

receive_real_32bit _ (&mass) ; 

/* - COMMUNICATION  WITH  POO 

- Q  */ 
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send_signed_16bit  _(&idrop_s _ ) ; 

/* - r - COMI-IUNICATION  WITH  P02 

- C  */ 

send_real_32bit _ {&acslev_s _ )  ; 

send_real_32bit _ (dtacsa_s _ ) ; 

send_real_32bit _ (&dtacsa_s _ [1] )  ; 

send_real_32bit _ (&dtacsa_s _ [2] ) ; 

send_real_32bit _ (&dtacsa_s _ [3] ) ; 

send_real_32bit _ (dtacsb_s _ ) ; 

send_real_32bit _ {&dtacsb_s _ [1] ) ; 

send_real_32bit _ (&dtacsb_s _ [2] ) ; 

send_real_32bit _ (&dtacsb_s _ [3] ) ; 

send_real_32bit _ (dtoffv_s _ ) ; 

send_real_32bit _ (&dtoffv_s _ [1] )  ; 

send_real_32bit _ (&dtoffv_s _ [2] ) ; 

send_real_32bit _ (&dtoffv_s _ [3] )  ; 

send_signed_l  6bit _ ( &  ithres_s _ )  ; 

send_signed_16bit _ {&ivcs_s _ )  ; 

send_signed_16bit _ (&ivtab_s _ )  ; 

send_real_32bit _ (&tatab_s _ ) ; 

send_real_32bit _ (&tburnm_s _ )  ; 

send_real_32bit _ (&timonv_s _ )  ; 

send_real_32bit _ (tofflt_s _ ) ; 

send_real_32bit _ (&tofflt_s _ [1] ) ; 

send_real_32bit _ (&tofflt_s _ [2] ) ; 

send_real_32bit _ (&tofflt_s _ [3] ) ; 

send_real_32bit _ (&tvtab_s _ ) ; 

/* - COMMUNICATION  WITH  P02 

- C  */ 

receive_s igned_l 6bit ( & iacson ) ; 

/* - COMMUNICATE  WITH  CORVEL - C  */ 

receive_real_32bit _ (vg) ; 

receive_real_32bit _ (&vg[l])  ; 

receive_real_32bit _ (&vg[2]) ; 

/* - DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG 

— . - . C  */ 

receive_real_32bit _ (ti2m)  ; 

receive_real_32bit _ (&ti2m[l] ) ; 

receive_real_32bit _ (&ti2mi2i ) ; 

receive_real_32bit _ (&ti2m[3] ) 

receive_real_32bit (&ti2m[4]  ) 

receive_real_32bit (&ti2m[5]  ) 

receive_real_32bit _ ^(&ti2m[6] )  ; 

receive_real_32bit _ (&ti2m[7] ) ; 

receive_real_32bit _ (&ti2m[8] ) ; 

receive_real_32bit _ (vrel) ; 

receive_real_32bit _ (&vrel[l] ) ; 

receive_real_32bit _ (&vreli2] ) ; 

receive_real_32bit _ (rrel) ; 

receive_real_32bit _ (&rrel[l] )  ; 

receive_real_32bit _ (&rrel [2] ) ; 

receive_real_32bit _ (6sp) ; 

receive_real_32bit _ (&sq) ; 

receive_real_32bit _ {&sr) ; 

send_real_32bit _ (smagr) ; 

send_real_32bit _ (Smagv) ; 

send_real_32bit _ (&tgo) ; 

send_real_32bit _ (spiter) ; 

ssnei  2702.1  32lDlt7  (^’*oll0r)  / 

send_real__32bit _ (syawer)  ; 

send_signed_16bit _ (Siburnl) ; 

send_real_32bit _ (lamd) ; 

send_real_32bit _ (&larnd[l])  ; 

send_signed_16bit _ (&acqd) ; 
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receive_signed_16bit _ (SestateJ ; 

receive_real_32bit _ t&piter) ; 

receive_real_32bit _ (&roller) ; 

receive_real_32bit _ (&yawer) ; 

receive_signed_16bit _ (Siburnl) ; 

receive_real_32bit _ (lamd)  ; 

receive_real_32bit _ (&lamd[l]) ; 

receive_signed_16bit _ (sacqd) ; 

receive_real_32bit _ (&tgel) ; 

receive_real_32bit _ (&tge2al) ; 

receive_real_32bit _ {&trmtgo) ; 


- C  */ 

/* - AUTOPILOTS 

- C  */ 

/* 


- C  */ 

/* 

c 

*/ 

/* 


- c  */ 

if  (tstep  >=  tapudriv)  { 
tapudriv  +=  tapustep; 
if  (t  >=  tkvon)  i 

/* 


. C  *! 

/* - VeS  LOGIC  MODULE 

- - C  */ 

/* 


- C  */ 

/*  Controls  the  kill  vehicle  velocity 

by  C  */ 

/*  determining  the  appropriate  VCS 

thruster  C  */ 

/*  on  and  off  times. 

C  */ 

/* 

C  */ 

/* 


- c  */ 

vcslog_{&t,  sr.iass,  lamd,  &tgo,  &magv,  &tgil,  strmtgo,  &tge2al, 

& 

tgel,  vgm,  &ivcs,  sidmeas,  siburnm,  Smidbrn,  siburnl,  & 
iburn2,  &iburn3,  sidist,  fltc,  sfltcp,  sfltcy,  &tsal,  & 
tsah,  tofflt,  stofltm,  stburnp,  stburny,  &tge2,  stgilp, 

& 

tgi2p,  &tgi3p,  stgily,  &tgi2y,  &tgi3y,  stimonv,  stgoflm, 

s 

tewait,  dtvesp,  dtvesy,  dtoffv,  stburnm) ; 

/*  SET  FLAG  TO  COMPUTE  VCS  THRUSTER  RESPONSE  TABLE  -^  / 

ivtab  =  1; 
tvtab  -  t; 

/* 


- C  */ 

/*  -  ftCS  resolving  logic  MODULE 

- C  */ 
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/* 


■C  V 


/* 


C  */ 

if  (ithrec  ==  1)  { 

resthr_(&t,  sidist,  Sanvp,  sdtsamp,  &tofltm,  straton, 

stpaton, 

styaton,  dtaesa,  dtacsb) ; 

/*  BEGINNING  TIME  OF  ACS  THRUSTER  RESPONSE  TABLE 

*/ 


tatab  =  t; 


/* 


} 

} 

ithres_s_ 
acslev_s_ 
dtacsa_s 
dtacsa_s 
dtacsa_<^ 
dtacsa_s 
dtacsb_s 
dtacsb_s 
dtacsb_s 
dtacsb_s 
dtof fv_s 
dtoffv_s 
dtof  fv__s 
dtof  fv[^s 

ivcs_s _ 

ivtab__s_ 
tatab_s_ 
tburnm_s_ 
timonv_s 
tofflt_s 
tof flt_s 
tofflt_s 
tofflt_s 
tvtab  s 


=  ithres; 
=  acslev; 


[0] 

=: 

dtaesa [0] 

il] 

dtaesa [1] 

[2] 

dtaesa [2] 

[3] 

= 

dtaesa 

3] 

[0] 

= 

dtacsb 

C] 

[1] 

3= 

dtacsb[l] 

[2] 

= 

dtacsb [2] 

[3] 

= 

dtacsb [3] 

[0] 

dtof fv 

0] 

[1] 

= 

dtof fv 

1] 

[2] 

dtof fv 

2] 

[3] 

= 

dtof fv 

3] 

ives  ; 

=  ivtab; 

=  tatab; 

=  tburnm; 

=  timonv; 
tO]  =  tofflt [0] ; 

[1]  =  tofflt [1] ; 

[2]  =  tofflt [2] ; 

[3]  =  tofflt [3] ; 
=  tvtab; 


- C  */ 

/* - 


TERMINATION  LOGIC 


- C  */ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


- c  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  (  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 

*/ 


Defines  the  simulation  termination 

conditions 
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/*  EVENTS  SCHEDULED  FOR  THIS  TIME  HAVE  BEEN  EXECUTED  */ 
if  (t  >=  tfinal)  { 
iexit  =  1; 

) 

/*  increment  time  */ 
tstep  +=  (float) 5.; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  { 
goto  LIOOO; 

1 

)  /*  MAIN  */ 
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B.3.13  Uupl2.c 

/*  uupl2.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


ifinclude  "f2c.h" 

/*  Common  Block  Declarations  */ 

struct  { 

real  tkf; 
shortint  idrtok; 

real  ppll,  ppl2,  pp22,  pyll,  pyl2,  py22,  plmdfp,  ylmdfp,  plamh, 
ylamh, 

plamdh,  ylamdh,  plamdf,  ylamdf,  tgil; 
shortint  kfmode,  ifpas; 

}  rkalmn_; 

#define  rkalmn_l  rkalmn_ 

/*  Table  of  constant  values  */ 
static  doublereal  c_b2  =  -.29912; 

/*  PROGRAM  EXOSIM  */ 

/* - 

-C  */ 

/*  -  Declare  and  initialize  variables  - 

-C  */ 

/* . . . . . . . 

-C  */ 

/*  Main  program  */  MAIN _ () 

{ 

/*  System  generated  locals 
doublereal  d_l; 

/*  Builtin  functions  */ 
double  pow_dd ( ) ; 

/*  Local  variables  */ 
static  shortint  acqd; 
static  real  lamd(2]; 
static  shortint  macq; 

static  real  asig,  magr,  lamm[2],  delt,  magv,  racq,  dtacsa_s _ [4], 

dtacsb_s _ [4],  rrel[3],  vrel[3]; 

static  shortint  term,  ives,  meso; 

static  real  acslev_s _ ,  dtoffv_s _ [4],  tofflt_s _ [4]; 

static  shortint  ithres_s _ ; 

extern  /*  Subroutine  */  int  send_signed_16bit _ (); 

static  real  tburnm_s _ ,  tkfudriv,  timonv_s _ ,  t,  tatab; 

static  shortint  track,  ivcab,  idrop; 

static  real  tvtab; 

static  shortint  iexit; 

static  real  piter; 

static  shortint  mterm; 

static  real  wfilt,  yawer,  zfilt,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  rea]  tge2al; 

static  shortint  iburnl; 

static  real  dtacsa[4J,  dtacsb[4]; 

extern  /■*  Subroutine  */  int  kalman  (); 
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static  real  lamsek[2],  acsiev,  tfinal; 
static  shortint  estate,  ivcs_s _ ; 

static  real  snracq,  dtoffv[4l,  magrtr,  lamdxx[2],  tofflt[4]; 

static  shortint  ithres; 

static  real  frmrat,  tburnm; 

static  shorcint  ireslv; 

static  real  roller; 

extern  /*  Subroutine  */  int  send_real _32bit _ (); 

static  real  timonv,  trmtgo; 
static  shortint  sektyp; 
static  real  lam[2],  cms[9]; 
extern  /*  Subroutine  */  int  cw87_(); 

static  real  tatab_s _ ,  tgo,  snr; 

static  shortint  ivtab_s _ ,  idrop_s _ ; 

static  real  tvtab_s _ ,  tgel,  ti2m[9]; 

extern  /*  Subroutine  */  int  receive_signed_16bit _ (); 

/*  THE  FOLLOWING  COMMON  BLOCKS  USED  FOR  MIDFLIGHT  CAPABILITIES  ONLY 
*/ 

/*  OUTPUTS  */ 

/*  NAMELIST  INPUTS  */ 

/*  DATA  INITIALIZATION  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA35.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA38.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA39.DAT*)  */ 

/*  $  INCLUDE  ('-'/INCLUDE/ SSDATA42.DAT')  */ 
h  $INCLUDE('-'/INCLUDE/SSDATA44.DAT')  */ 

/*  $INCLUDE( '"/INCLUDE/SSDATA45.DAT';  */ 

/*  $  INCLUDE  {'''/INCLUDE/SSDATA4  6.  DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA47.DAT')  */ 

/*  $INCLUDE('-'/INCLUDE/SSDATA48.DAT’)  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA49.Lrtr')  */ 

/*  $INCLUDE< '-'/INCLUDE/SSDATASO.DAT')  »/ 

/*  SINCLUDEC-'/INCLUDE/SSDATAOl.DAT')  */ 

/*  $INCLUDE('^/INCLUDE/SSDATA17.DAT')  */ 

/*  $  INCLUDE  ('-'/ INCLUDE/SSDATAl  8.  DAT' )  */ 

/*  $  INCLUDE  ('-'/INCLUDE/SSDATA21.  DAT')  */ 

/*  $INCLUDE('-'/INCLUDE/SSDATA22.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA23.DAT')  */ 

/*  $INCLUDE( '''/INCLUDE/SSDATA28.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA29.DAT')  */ 

/*  $INCLUDE('''/INCLUDE/SSDATA30.DAT')  */ 

/*  $  INCLUDE  ('''/INCLUDE/SSDATA71.  DAT’)  */ 

/*  SlNCLUDEC-'/INCLUDE/SSTIMING.DAT')  */ 

/*  SINCLUDEC  :pfp:INCLUDE/target.fo>-')  */ 

/*  INITIALIZE  80x87  */ 

Cw87_{) ; 

/*  $INCLUDE( 'SSpl2.DAT')  */ 

idrop_s _  =  idrop; 

acslev_s _  =  acsiev; 

dtaesa  s  ~[0]  =  dtacsa(0]; 

dtacsa_s _ [1]  =  dtaesa [ 1]; 

dtacsa_s _ [ 2 ]  =  dtaesa [2] ; 

dtacsa_s _ [3]  =  dtaesa [3]; 

dtacsb_s _ [0]  =  dtacsb[0]; 

dtacsb_s _ [1]  =  dtacsbil]; 

dtacsb_s _ [2]  -  dtacob[2]; 

dtacsb_s _ [3]  =  dtacsb[3]; 

dtoffv_s _ [0]  =  dtoffvioj; 

dtoffv_s _ [1]  =  dtoffvil]; 

dtoffv_s _ [2]  =  dtoffv(2]; 

dtoffv_s _ [3]  =  dtoffv[3]; 

ithres  s  =■ ithres; 
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/* 


ivcs_s _  =  ives; 

ivtab_s =  ivtab; 

tatab_s =  tatab; 

tburnm_s =  tburnm; 

timonv_s =  timonv; 

tofflt_s _ [0]  =  tofflt[0] 

tofflt_s _ [1]  =  toffltd] 

tofflt_s _ (2]  =  tofflt(2] 

tofflt_s _ [3]  =  tofflt[3] 

tvtab  s  =  tvtab; 


- C  */ 

/* - main  execution  loop 

- C  */ 

/* 


- c  *! 

/* 

c 

*/ 

/* 

c 

*/ 

/* 

c 

*/ 

/* 


Execution  of  all  events  is  performed 


within  this  loop 


- C  */ 

LIOOO: 

/*  WRITE(*,*)' - BEGINNING  OF  LOOP - '  */ 

/* 


- C  */ 

/* - 


Processor  communication 


- C  */ 

/*  -  COMMUNICATION  WITH  SEEKER 

- C  */ 

receive_real_32bit _ (lamm)  ; 

receive_real_32bit _ (&lamm(l] ) ; 

receive_real_32bit _ (&snr) ; 

receive_real_32bit _ (&frmrat) ; 

/* - COMMUNICATION  WITH  P03 

- C  */ 

receive_signed_16bit _ (&ireslv) ; 

receive_real_32bit _ (lamdxx) ; 

receive_real_32bit _ {& lamdxx [1] ) ; 

receive_real_32bit _ (lamsek) ; 

receive_real_32bit _ (Slamsek [1] ) ; 

receive_real_32bit _ (smagrtr) ; 

/* - DAISY  CHAIN  WITH  IMUPRO  AND  NAVIG 

- C  */ 

receive_real_32bit _ (ti2m) ; 

receive_reax_32bit _ (&ti2m(l] ) ; 

receive_real_32bit _ (&ti2mi2] ) ; 

receivc_rcal_32bit _ (&ti2m[3j ) 

receive_real_32bit _ (&ti2m[4i ) 

receive_real_32bit _ (&ti2mi5] ) ; 

receive_real_32bit _ (&ti2m[6] ) ; 

receive_real_32bit  (&ti2m[7]); 
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receive_reai_32bit _ (&ti2m[8] )  ; 

receive_real_32bit _ ^(vrel) ; 

receive_real_32bit _ (svrelil] ) ; 

receive_real_32bit _ (&vreli2] )  ;• 

receive_reai_32bit _ (rrel)  ; 

receive_real_32bit _ (&rrel [1] ) ; 

roceive_real_32bit _ (&rrel [2] )  ; 


■C  */ 


/* 


C  */ 


KALMAN  FILTER  MODULE 


- C  */ 

/*  Filter  LOS  anales 

C 
*/ 

/* 

C 

*/ 

I* 


- C  */ 

receive_real__32bit _ (smagr)  ; 

receive_real__32bit _ (&magv)  ; 

receive_real_32bit _ (&tgo)  ; 

receive_real_32bit _ Upiter)  ; 

receive__real_32bit _ (sroller)  .• 

receive_real_32bit _ Uyawer)  / 

receive_signed_16bit _ (&iburnl) ; 

receive_real_32bit _ (lamd) ; 

receive_real__32bit _ (filamdfl]  > 

receive_signed_16bit _ {£acqd) ; 

if  (tstep  >=  t’kfudriv)  ( 

/*  TKFUDRIV  =  TKFUDRIV  +  TKFUSTEP  */ 

tkfudriv  +=  (shortint)  { (float)  le3  /  frinrat)  ; 

/*  write (message, 103) t  */ 

/*  103  format ('  kalman' , flO . 4)  */ 

/*  call  outrnes (message)  */ 

/*  CALL  FILTER  IF  SNR  IS  SUFFICIENT  */ 

if  (snr  >=  snracq  i 1  sektyp  !=  2)  { 
if  (sektyp  ==  1  | |  sektyp  ==  2)  { 
d_l  =  (doublereal)  snr; 

asig  =  pow_dd(&d_i,  &c_b2)  *  (float)32.56  *  (float)le-6; 

} 

kdlman_(&t,  ti2m,  lamm,  &asig,  &snr,  &tgo,  rrel,  vrel,  ti2m, 
racq,  Smagrtr,  &magr,  &magv,  lamsek,  lamdxx,  sfrmrat, 

ems. 


£ 


£macq,  £mcso,  £mterm,  £ireslv,  £track,  £term,  £trmtgo. 


£acqo, 

) 


tgel,  £tge2al,  £wfilt,  szfilt,  lam,  lamd,  £iburnl, 
£estate,  £piter,  ayawer,  £roliei); 


£ 


) 

send_signed_16bit _ (fiestate) ; 

send_real_32bit  (£piter) ; 
send_real“'32bit  _(£roller)  ; 
send  real  32bit~  (£vaw£r) ; 

send__signed_16bit _ (.. '  ournl)  ; 

send_real_32bit _ (lamd)  ; 

send_real_32bit _ (£lamd[l] )  ; 

send_signed_16bit _ (£acqd) ; 
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send_real_32bit _ (&tgel) ; 

send_real_32bit _ {&tge2al) ; 

send_real_32bit _ {strmtgo)  ; 


- C  */ 

/* - TERMINATION  LOGIC 

- C  */ 

/* 


- C  */ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 

C 

*/ 

/* 


Defines  the  simulation  termination 


conditions 


- C  */ 

/*  INITIALIZE  SIMULATION  EXIT  FLAG  TO  ZERO  '(  PREVENTS  EXIT  )  */ 

iexit  =  0; 

/*  ENABLE  EXIT  IF  MAXIMUM  SIMULATION  TIME  HAS  BEEN  EXECUTED  AND  ALL 
*/ 

/*  EVENTS  SCHEDULED  FOR  THIS  TIME  HA"E  BEEN  EXECUTED  */ 
if  (t  >=  tfinal)  { 
iexit  =  1; 

1 

/*  increment  time  */ 
tstep  +=  (float) 1 .  ; 
t  =  tstep  *  delt; 

/*  CONTINUE  LOOPING  UNTIL  ONE  OR  MORE  EXIT  CONDITIONS  HAVE  BEEN  MET 
*/ 

if  (iexit  ==  0)  ( 
goto  LIOOO; 

) 

)  /*  MAIN  */ 
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A. 4  Crossbar  Code 


#define 

relay  y3 

sspOO 

is 

sspOO . fpp 

on 

xl 

sspOl 

is 

sspOl . fpx 

on 

xl5 

ssp02 

is 

ssp02 . fpp 

on 

x2 

ssp03 

is 

ssp03 . fpx 

on 

xl4 

ssp04 

is 

ssp04 . fpx 

on 

xl3 

sspOS 

is 

sspOS . fpp 

on 

x5 

ssp06 

is 

ssp06 . fpp 

on 

x6 

ssp07 

is 

ssp07 . fpp 

on 

x7 

ssp08 

is 

ssp08 . fpx 

on 

yi3 

ssp09 

is 

ssp09 . fpx 

on  yl4 

ssplO 

is 

ssplO . fpx 

on 

xll 

sspll 

is 

sspll . 386 

on 

xlO 

sspl2 

is 

sspl2 . fpp 

on 

xl2 

timer  is 

fpptimer . fpp 

on  yl5 

print 

is 

print .386 

on 

p23 

loop 

cycle 

ssp01,sspl0  :=  ssp08.2;  [REAL  GR(Ol)  ] 

[  relay, sspOl, ssplO  :=  ssp08.2;  REAL  GR(Ol)  ] 

cycle 

ssp01,sspl0  :=  ssp08.2;  [  REAL  GR(02)  ] 
print  :=  sspOO.2;  [REAL  PHI] 

cycle 

ssp01,sspl0  :=  ssp08.2;  [  REAL  GR(03)  ] 
print  ;=  sspOO.2;  (REAL  THT] 

cycle 

sspll  :=  sspOO.2;  [  REAI*8  IXX  ] 
print  :=  sspOl.2;  (  T  ] 

cycle 

sspll  :=  sspOO.2;  [  F;EAL*8  lYY  ] 
print  :=  ssp08.2;  [REAL  ALT] 


cvcle 

sspll  :=  sspOO.2;  [  REAL*8  IZZ  ] 
cycle 

SSpOl, sspll, ssp06, ssp08  :=  sspOO.2;  [  REAL*8  MASS  ] 


cycle 

sspOl  :=  ssplO.2;  (  REAL*8  PULSEA(Ol)  ] 
print  :=  sspOO.2;  [REAL  PSI] 


cycle 

sspOl  :=  ssplO.2;  [  REAL*8  PULSEA(02)  ] 
cycle 

sspOl  :=  ssplO.2;  [  REAL*8  PULSEA(03)  ] 


cycle 

ssp02, ssplO, ssp05  :=  ssp06.2;  [  cg(l)  ] 
sspl2  :=  ssp09.2;  [  lamm(l)  ] 


cycle 
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SspOl  :=  ssp04.2;  [  REAL*8  PULSEG(Ol)  ] 
ssp02, ssplO, sspOS  :=  ssp06.2;  [  cg(2)  ] 
sspl2  ;=  ssp09.2;  [  lamm(2)  ] 

cycle 

SspOl  :=  ssp04.2;  [  REAL* 8  PULSEG(02)  ] 
ssp02, ssplO, sspOS  :=  ssp06.2;  [  cg(3)  ] 
sspl2  :=  ssp09.2;  [  snr  ] 

cycle 

SSpOl  :=  ssp04.2;  [  REAL*8  PULSEG{03)  ] 
sspl2  :=  ssp09.2;  [  frmrat  ] 

cycle 

sspOl  :=  ssp08.4;  [  REAL*8  XYZE(Ol)  ] 
ssp04,sspl0  :=  sspOO.2;  [  REAL*8  P  ] 

cycle 

sspOl  :=  SSp08.4;  [  REAL*8  XYZE(02)  ] 
ssp03, ssp04, ssplO  :=  SspOO.2;  [  REAL*8  Q  ] 

cycle 

sspOl  :=  ssp08.4;  [  REAL*8  XYZE(03)  ] 
ssp03, ssp04, ssplO  ;=  SspOO.2;  [  REAL*8  R  ] 

cycle 

sspOl  ssp08.4;  [  REAL*8  XYZED(Ol)  ] 
cycle 

sspOl  :=  SSp08.4;  [  REAL*8  XYZED(02)  ] 
cycle 

sspOl  :=  ssp08.4;  [  REAL*8  XYZED(03)  ] 
cycle 

sspOl, ssp03  ;=  ssp08.4;  [  REAL*8  X  ] 
cycle 

sspOl, ssp03  :=  ssp08.4;  [  REAL*8  Y  ] 
cycle 

sspOl, ssp03  :=  ssp08.4;  [  REAL*8  Z  ] 
cycle 

ssp07, print  ;=  ssp08.2;  [  REAL  X  ] 
cycle 

ssp07, print  :=  ssp08.2;  [  REAL  Y  ] 
cycle 

ssp07, print  :=  ssp08.2;  [  PEAL  Z  ] 
cycle 

sspOO, sspOl, ssp03, ssplO, ssp07, print  :=  ssp08.2;  [  REAL  XD  ] 
cycle 

SspOO, sspOl, ssp03, ssplO, ssp07, print  :=  ssp08.2;  [  REAL  YD  ] 
cycle 

sspOO, sspOl, ssp03, ssplO, ssp07, print  :=  ssp08.2;  [  REAL  ZD  ] 
cycle 

ssp03,ssp04, ssplO, ssp08  :=  sspOO. 2;  (  REAL*8  CIM(l)  ] 
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cycle 

ssp03, ssp04, ssplO, ssp08  :=  sspOO.2;  [  REAL*8  CIM(2)  ] 
cycle 

ssp03, ssp04, ssplO, ssp08  :=  sspOO.2;  [  REAL*8  CIM(3)  ] 
cycle 

ssp03, ssp04, ssplO, ssp08  :=  SSpOO.2;  [  REAL*8  CIM(4)  ] 
cycle 

ssp03, ssp04, ssplO, ssp08  :=  sspOO.2;  (  REAL*8  CIM{5)  ] 
cycle 

ssp03, ssp04, ssplO, ssp08  :=  sspOO.2;  (  REAL*8  CIM{6)  ] 
cycle 

ssp03, ssp04, ssplO, ssp08  :=  SSpOO.2;  (  REAL*8  CIM(7)  ] 
cycle 

ssp03, ssp04, ssplO, ssp08  :=  SSpOO.2;  [  REAL*8  CIM(8)  ] 
cycle 

ssp03, SSp04, ssplO, SspOa  :=  sspOO.2;  [  REAL*8  CIM(9)  ] 
cycle 

SSpOO  :=  sspll.l;  [  INTEGER  IDROP  ] 
cycle 

sspOO  ;=  ssp02.2;  [  mdotV  } 
cycle 

sspOO  :=  ssp05.2;  [  mdota  ] 
ssp08  :=  ssp02.2;  [  fxvcs  ] 

cycle 

ssp08  :=  ssp02.2.*  [  fyves  ] 

SSp07  :=  sspOl.2;  [  REAL*8  RMIR(l)  ] 

cycle 

ssp08  :=  ssp02.2;  [  fzves  ] 

SSp07  :=  sspOl.2;  [  REAL*8  RMIR(2)  ] 

cycle 

sspOO  ;=  ssp02.2;  [  mxvcs  ] 

SSp07  :=  sspOl.2;  [  REAL*8  RMIR{3)  ] 

cycle 

sspOO  :=  ssp02.2;  (  myves  ] 

ssp07  :=  sspOl.2;  [  REAL*3  VMIR(l)  ] 

cycle 

sspOO  :=  ssp02.2;  [  mzves  ] 

ssp07  :=  sspOl.2;  [  REAL*8  VMIR(2)  ] 

cycle 

ssp08  :=  ssp05.2;  [  fxacs  ] 

ssp07  :-=  sspOl.2;  (  REAL*8  VMIR(3)  ] 

cycle 

ssp08  :=  ssp05.2;  [  fyacs  ] 

SSpOl  :=  ssp03.4;  [  REAL*8  GRT(01,01)  ] 

cycle 

ssp08  :=  sspC5.2;  [  fzacs  ] 
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sspOl 

cycle 

sspOO 

sspOl 

cycle 

sspOO 

sspl2 

cycle 

sspOC 

sspl2 

cycle 

ssp05 

sspl2 

cycle 

sspOS 

sspl2, 


ssp03 . 4 ; 

[ 

REAL *8 

GRT{01,02) 

sspOS . 2 ; 

[ 

mxacs  ] 

SSp03 . 4; 

[ 

REAL* 8 

GRT(01,03) 

sspOS. 2; 

[ 

myacs  ] 

ssp03 . 1; 

[ 

INTEGER  IRESLV  ] 

sspOS. 2; 

[ 

mzacs  ] 

ssp03.2; 

[ 

REAL* 8 

LAMDXX(Ol) 

sspll .2; 

[ 

REAL*8 

ACSLEV  ] 

ssp03 . 2 ; 

[ 

REAL* 8 

LAMDXX(02) 

sspll .2; 

[ 

REAL* 8 

DTACSA(Ol) 

SSp09  :=  ssp03.2;  [  REAL*8  LAMSEK(Ol) 


] 


cycle 

SSpOS  :=  sspll.2;  [  REAL*8  DTACSA(02)  ] 
sspl2,ssp09  :=  SSp03.2;  [  REAL*8  LAMSEK(02)  ] 


cycle 

sspOS  :=  sspll.2;  [  REAL*8  DTACSA(03)  ] 
sspl2, ssp09, print  :=  ssp03.2;  [  REAL*8  MAGRTR  ] 


cycle 

sspOS  :=  sspll.2;  [  REAL*8  DTACSA(04)  ] 
sspOl, print  :=  ssp03.4;  [  REAL*8  RTIC(01,01)  ] 


cycle 

sspOS  :=  sspll.2;  [  REAL*8  DTACSB(Ol)  ] 
sspOl, print  :=  ssp03.4;  [  REAL*8  RTIC(01,02)  ] 

cycle 

sspOS  :=  sspll.2;  [  REAL*8  DTACSB(02)  ] 
sspOl, print  :=  ssp03.4;  [  REAL*8  RTIC(01,03)  ] 


cycle 


sspOS 

=  sspll.2; 

sspOl 

=  SSp03.4; 

cycle 

sspOS 

=  sspll.2; 

sspOl 

=  SSp03.4; 

cycle 

ssp02 

=  sspll.2; 

sspOl 

=  ssp03.4; 

cycle 

ssp02 

=  sspll.2; 

ssplO 

=  sspOO. 2; 

ssp07 

=  sspOl. 2; 

cycle 

ssp02 

=  sspll.2; 

ssplO 

=  sspOO. 2; 

ssp07 

=  SSpOl.2; 

REAL*8  DTACSB(03)  ] 
REAL*8  VTIC(01,01)  ] 


REAL* 8  DTACSB(04)  ] 
REAL*8  VTIC(01,02)  ] 


REAL*8  DTOFFV(Ol)  ] 
REAL*8  VTIC(01,03)  ] 


REAL*8  DTOFFV(02)  ] 
REAL* 8  PD  ] 

REAL* 8  AT{1)  ] 


REAL*8  DTOFFV(03)  ] 
REAL *8  QD  ] 

REAL*8  AT (2)  ] 
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cycle 

ssp02  :=  sspll.2;'  [  REAL* 8  DTOFFV(04)  ] 
SsplO  :=  sspOO.2;  [  REAL*8  RD  ] 
ssp07  :=  sspOl.2;  [  REAL*8  AT (3)  ] 

cycle 

SSpOS  :=  sspll.l;  [  INTEGER  ITHRES  ] 
cycle 

SSp02  :=  sspll.l;  [  INTEGER  IVCS  ] 
cycle 

ssp02  :=  sspll.l;  [  INTEGER  IVTAB  ] 
cycle 

SSpOS  :=  sspll.2;  [  REAL*8  TATAB  ] 
cycle 

SSp02  :=  sspll.2;  [  REAL*8  TBURNM  ] 
cycle 

ssp02  :=  sspll.2;  [  REAL*8  TIMONV  ] 
cycle 

ssp02  :=  sspll.2;  [  REAL*8  TOFFLT(Ol)  ] 
cycle 

ssp02  :=  sspll.2;  [  REAL*8  TOFFLT(02)  ] 
cycle 

ssp02  :=  sspll.2;  (  REAL*8  TOFFLT(03)  ] 
cycle 

ssp02  :=  sspll.2;  [  REAL*8  TOFFLT(04)  ] 
cycle 

ssp02  :=  sspll.2;  [  REAL*8  TVTAB  ] 
cycle 

sspll  :=  sspOS.l;  [  INTEGER  lACSON  ] 
cycle 

ssplO  ;=  ssp08.2;  (  REAL*8  UD  ] 
sspll  :=  ssp07.2;  [  REAL*8  VG(1)  ] 

cycle 

ssplO  ;=  ssp08.2;  [  REAL*8  VD  ] 
sspll  :=  ssp07.2;  [  REAL*8  VG(2)  ] 

cycle 

ssplO  :=  ssp08.2;  (  REAL*8  WD  ] 
sspll  :=  ssp07.2;  [  REAL*8  VG(3)  ] 

cycle 

sspll, sspl2  :=  sspOl.2;  [  ti2m(l)  ] 
cycle 

sspll, sspl2  :=  sspOl.2;  [  ti2m{2)  ] 
cycle 

sspll, sspl2  :=  sspOl.2;  [  ti2m(3)  ] 
cycle 

sspll, sspl2  :=  sspOl.2;  (  ti2m(4)  ] 
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cycle 

sspll,sspl2  :=  sspOl.2;  [  ti2m(5)  ] 
cycle 

sspll,sspl2  :=  sspOl.2;  [  ti2m(6)  1 
cycle 

sspll,sspl2  :=  sspOl.2;  [  ti2ra(7)  ] 
cycle 

sspll,sspl2  :=  sspOl.2;  [  ti2m<8)  ] 
cycle 

sspll,sspl2  ;=  sspOl.2;  (  ti2m-;9)  ] 
cycle 

sspll,sspl2  :=  SSpOl.2;  [  VREL(l)  ] 
cycle 

sspll,sspl2  :=  sspOl.2;,  [  VREL(2)  ] 
cycle 

sspll,sspl2  :=  sspOl.2;  [  VREL(3)  ] 
cycle 

sspll,sspl2  :=  SSpOl.2;  [  RREL(l)  ] 
cycle 

sspll,sspl2  :=  SSpOl.2;  [  RREL(2)  ] 
cycle 

sspll,S£pl2  :=  sspOl.2;  (  RREL(3)  ] 
cycle 

sspll  :=  sspOl.2;  (  sp  ] 
cycle 

sspll  :=  sspoi.2;  [  sq  ] 
cycle 

sspll  :=  sspOl.2;  (  sr  ] 
cycle 

sspl2  :=  sspll. 2;  [  magr  ] 
cycle 

sspl2  :=  sspll. 2;  [  magv  ] 
cycle 

sspl2, print  sspll. 2;  [  tgo  ] 
cycle 

sspl2  :=  sspll. 2;  [  piter  ] 
cycle 

sspl2  :=  sspll. 2;  [  roller  ] 
cycle 

sspl2  :=  sspll. 2;  [  yawer  ] 
cycle 

sspl2  :=  sspll. 1;  [  iburnl  ] 
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cycle 

sspl2  :=  sspll.2;  (  lamd{l)  ] 
cycle 

sspl2  :=  sspll.2;  [  lamd(2)  ] 
cycle 

sspl2  :=  sspll.l;  [  acqd  ] 
cycle 

sspll  :=  sspl2.1;  [  estate  ] 
cycle 

sspll  :=  sspl2.2;  [  piter  ] 
cycle 

sspll  :=  sspl2.2;  [  roller  ] 
cycle 

sspll  :=  sspl2.2;  [  yawer  ] 
cycle 

sspll  :=  sspl2.1;  [  iburnl  ] 
cycle 

sspll  :=  sspl2.2;  [  lamd(l)  ] 
cycle 

sspll  :=  sspl2.?;  [  lamd(2)  ) 
cycle 

sspll  :=  sspl2.1;  [  acqd  ] 
cycle 

sspll  :=  sspl2.2;  [  tgel  ] 
cycle 

sspll  :=  sspl2.2;  [  tge2al  ] 
cycle 

sspll  sspl2.2;  [  trmtgo  ] 
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